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This  final  technical  report  documents  research  performed  from  1  March 
1979  to  29  February  1980  under  Air  Force  Office  of  Scientific  Research  (AFOSR) 
Contract  F496209-79-C-0078.  This  research  program  was  conducted  at  United 
Technologies  Research  Center  (UTRC),  East  Hartford,  Connecticut  06108.  Major 
Charles  L.  Nefzger  served  as  the  AFOSR  Scientific  Officer. 

This  report  is  issued  as  UTRC  Report  R80-944590-1 . 
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Microprocessor  Requirements  for  Implementing 
Modern  Control  Logic 


SUMMARY 


A  demonstration  of  the  use  of  microprocessors  for  implementing  linear 
quadratic  Gaussian  (LQG)  control  was  conducted.  The  demonstration  consisted  of 
simulating  linear  system  dynamics  on  an  analog  computer  and  implementing  LQG 
control  and  estimation  dynamics  on  a  microprocessor.  Two  cases  were  studied,  a 
single  input  second  order  system  and  a  four  input  fifth  order  system.  The  second 
order  system  was  controlled  using  an  Intel  8080  8-bit  microprocessor  and  the 
fifth  order  system  was  controlled  using  a  16-bit  Digital  Equipment  Corporation 
LSI  11/2  microprocessor.  Key  requirements  addressed  in  this  study  included 
microprocessor  requirements  for  (1)  word  size  (2)  computational  capability 
including  arithmetic  and  input/output  operations  and  (3)  memory  requirements.  The 
requirements  were  compared  against  predicted  requirements  made  using  previously 
developed  analytic  techniques 

The  implementation  involved  developing  general  purpose  algorithms  required 
for  implementing  LQG  control  and  estimation.  These  algorithms  consisted  of 
matrix/vector  multiplication,  vector  additon  and  input/output  service  routines. 

The  same  algorithms  were  employed  in  both  the  second  order  and  the  fifth  order 
demonstration. 

Analytic  procedures  were  developed  for  establishing  microprocessor  require¬ 
ments  for  control  of  nonlinear  systems.  Techniques  were  described  for  designing 
nonlinear  controls  based  on  the  application  of  LQG  theory  in  which  the  nonlinear 
system  dynamics  were  approximated  by  a  series  of  linearized  system  descriptions 
at  a  number  of  operating  points.  Linear  control  and  estimation  methodology  was 
applied  to  the  linearized  descriptions  resulting  in  a  series  of  piecewise 
optimal  state  variable  feedback  controls.  Techniques  are  described  for  synthe¬ 
sizing  the  nonlinear  control  and  estimation  equations  by  scheduling  the  piece- 
wise  optimal  gains  between  operating  points.  Microprocessor  requirements  were 
then  predicted  for  the  piecewise  optimal  configuration  in  terms  of  computational 
operation  and  total  memory  required. 

This  research  was  performed  for  the  U.S.  Air  Force  Office  of  Scientific 
Research  under  Contract  F49620-79-C-0078 . 
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RESULTS  AND  CONCLUSIONS 


1)  The  implementation  of  modern  control  and  estimation  techniques  based  on 
linear  quadratic  Gaussian  (LQG)  methodology  was  successfully  demonstrated  using 
commercially  available  microprocessors .  The  demonstration  was  conducted  for 
both  a  single  input  second  order  linear  system  and  a  four  input  fifth  order 
linear  system.  The  linear  system  dynamics  were  simulated  on  an  analog  computer 
and  the  LQG  control  was  implemented  using  microprocessors.  An  eight  bit  Intel 
8080  microprocessor  was  used  to  control  the  second  order  system  and  a  sixteen 
bit  Digital  Equipment  Corporation  LSI  11/2  microprocessor  was  used  to  control 
the  fifth  order  system. 

2)  Analytic  techniques  developed  in  the  Phase  I  portion  of  the  program  were 
applied  to  predict  the  microprocessor  requirements  prior  to  implementation. 

These  techniques  resulted  in  procedures  for  addressing  key  issues  associated 
with  microprocessor  implementation  including  word  size,  computational  require¬ 
ments,  and  memory.  Application  of  the  prediction  techniques  resulted  in 
estimates  for  both  the  second  order  and  the  fifth  order  system  in  terms  of 
these  key  issues.  The  actual  requirements  resulting  from  this  study  agree  with 
predicted  values.  However,  the  particular  characteristics  of  the  interface 
between  the  microprocessor  and  the  analog  system  i.e.  ,  the  D/A  converters  and 
A/D  converters  may  lead  to  additional  software  being  required  to  ensure  proper 
scaling.  Also,  additional  software  requirements  arise  because  of  the  detailed 
characteristics  of  the  hardware  multiplication  function.  Thebe  two  features 
are  device  dependent  and  the  requirements  in  terms  of  software  to  work  with 
them  will  depend  on  the  devices  selected.  The  analytic  prediction  techniques 
are  very  accurate  in  specifying  the  number  and  type  of  operation  i.e.,  addition, 
multiplication,  with  some  qualification.  In  the  actual  implementation  it  was 
found  that  additional  software  was  required  beyond  that  predicted.  This 
additional  software  was  required  to  (1)  properly  account  for  necessary  scaling 
between  the  microprocessor  and  the  analog  simulation  and  (2)  allow  for  signed 
multiplication  and  division  when  using  a  hardwired  multiplication  option  on  the 
LSI  11/2. 

3)  The  Phase  I  study  indicated  that  the  number  of  operations  required  per 
sample  time  as  well  as  the  memory  requirements  were  dependent  on  the  structure 
of  the  system.  Transformation  could  be  used  to  express  the  system  state  vector 
in  a  new  coordinate  system  which  in  turn  could  be  used  as  a  basis  for  designing 
the  LQG  control.  Typical  transformations  include  both  the  Jordan  canonical  and  the 
Companion  form.  While  transformation  to  one  of  these  forms  offers  the  potential 
for  increased  speed  and  reduced  memory  requirements,  it  was  found  that  it  is 

not  always  practical  to  use  this  approach.  A  transformation  was  used  for  the 
fifth  order  system  in  an  attempt  to  reduce  the  number  of  analog  computer 
components  needed.  However,  when  the  control  and  estimation  matrices  for  the 
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transformed  systems  were  calculated  it  was  found  that  they  contained  numbers 
ranging  over  eleven  orders  of  magnitude.  The  large  range  of  values  could  not 
be  accommodated  by  the  16  bit  word  size  of  the  LSI  11/2. 

Although  it  is  possible  to  reduce  the  number  of  operations  and  memory  required 
by  state  vector  transformation  there  is  no  guarantee  that  the  result  will  be 
amenable  to  implementation  on  a  (fixed  point)  microprocessor.  The  use  of  such 
transformations  should  be  with  caution.  Evaluating  a  particular  microprocessor 
for  implementing  LQG  control  should  be  done  first  on  the  basis  of  the  physical 
system  description.  Resort  to  alternate  forms  may  reduce  the  apparent  number 
of  computations  and  memory  required  but  the  scaling  issue  discussed  above  must 
be  considered. 

4)  The  second  order  system  validation  using  on  Intel  8080  microprocessor  required 
4.7  ms  computation  time  compared  with  the  predicted  value  of  4.25  ms.  The  actual 
memory  used  was  483  words  of  which  468  were  PROM  and  15  were  RAM.  The  predicted 
values  were  490  words  including  15  words  of  RAM  and  475  words  of  PROM. 

The  fifth  order  system  validation  using  an  LSI  11/2  microprocessor  required 
14.45  ms  computation  time  compared  with  the  predicted  value  of  9.68  ms.  The 
discrepency  is  due  to  the  additional  software  required  to  execute  signed  multip¬ 
lication  which  was  not  accounted  for  in  the  prediction.  The  actual  memory  used 
was  422  words  of  which  109  words  were  RAM  and  313  words  were  PROM.  The  predicted 
memory  requirements  were  304  wo.ds  including  121  words  of  RAM  and  183  words  of 
PROM.  The  differences  between  the  actual  and  estimated  memory  requirements  is 
primarily  due  to  the  additional  software  for  signed  multiplication. 

5)  Microprocessor  requirements  for  implementing  control  and  estimation  for  non¬ 
linear  systems  were  defined.  The  nonlinear  control  and  estimation  structure  was 
developed  based  on  a  piecewise  linear  approach  which  approximates  the  nonlinear 
system  by  a  series  of  linearized  systems  evaluated  at  various  operating  points 
of  the  system. 

Optimal  linear  control  and  estimation  designs  are  developed  for  each  oper¬ 
ating  point  based  on  LQG  theory.  These  designs  are  coupled  together  by  schedul¬ 
ing  the  control  and  estimation  matrices  between  operating  points  using  linear 
interpolation  as  a  function  of  the  state  of  the  nonlinear  system. 

Microprocessor  requirements  for  implementing  the  nonlinear  configuration 
indicate  the  largest  impact  is  in  the  additional  memory  required  compared  to 
the  linear  system.  The  additional  memory  results  from  the  requirement  that 
control  and  estimation  matrices  must  be  stored  for  each  operating  point  con¬ 
sidered.  However,  the  increased  memory  is  a  linear  function  of  the  number  of 
operating  points.  This  coupled  with  the  facts  that  1)  the  memory  requirements 
for  LQG  are  small  and  2)  large  capacity  memories  have  been  available  for  some 
time  indicates  that  the  memory  requirements  for  nonlinear  implementation  are 
not  excessive. 
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INTRODUCTION 


Over  the  past  several  years  use  of  modern  control  methodology  —  in 
particular,  linear  quadratic  Gaussian  (LQG)  theory  —  has  gained  increased 
recognition  as  an  effective  design  tool  for  control  of  nonlinear  multivariable 
stochastic  systems  (Refs.  1-8).  The  referenced  studies  have  been  conducted 
under  a  combination  of  AFOSR,  Office  of  Naval  Research  (ONR),  Air  Force  Aero 
Propulsion  Laboratory  (AFAPL),  NASA-Lewis  and  Pratt  &  Whitney  Aircraft  (P&WA) 
support.  In  these  as  well  as  many  other  aerospace  applications  the  primary 
impetus  for  application  of  modern  LQG  control  concepts  is  improved  system 
performance  combined  with  the  advent  of  digital  electronic  control  implementa¬ 
tion.  Digital  electronics  provide  the  means  by  which  complex  controllers 
associated  with  LQG  theory  can  be  implemented.  The  current  trend  both  within 
as  well  as  outside  the  aerospace  controls  community  toward  increased  use  of 
digital  electronics  —  in  particular,  microprocessors  —  will  lead  to  increased 
use  of  modern  control  logic  including  system  identification,  modeling,  estima¬ 
tion,  and  multivariable  control  methodologies  (Ref.  9).  In  addition,  use  of 
microcomputer  controllers  will  lead,  in  many  instances,  to  reduced  control  cost 
(Refs.  10  and  11),  lighter  and  smaller  controls  (Ref.  12),  lower  power  require¬ 
ments  and  integrated  circuit  reliability  (Ref.  13).  Recent  studies  (Ref.  14) 
have  demonstrated  that  existing  microprocessor  can  be  used  to  implement  algor¬ 
ithms  for  parameter  identification  of  relatively  simple,  low-order  dynamic 
systems . 

However,  prior  to  widespread  use  of  microprocessors  for  modern  control  logic 
implementation  key  issues  associated  with  microprocessor  implementation  of  LQG 
control  and  estimation  concepts  must  be  addressed  and  resolved.  These  issues 
include  (1)  accuracy,  (2)  computational  capability,  (3)  memory,  and  (4)  inter¬ 
face  requirements  (Ref.  15).  These  requirements  depend  upon  system  dynamics  as 
well  as  upon  the  particular  control  algorithm  employed.  Defining  these  require¬ 
ments  will  establish  criteria  for  selecting  the  appropriate  computer  system  for 
control  implementation. 

To  address  these  important  issues  a  two  phase  two  year  program  directed 
toward  establishing  microprocessor  requirements  for  implementating  modern 
control  logic  was  initiated  at  UTRC  under  AFOSR  support  in  1978.  The  Phase  I 
study  (Ref.  16)  was  concerned  with  establishing  analytic  techniques  for  evaluating 
microprocessor  requirements  for  implementing  modern  control  and  estimation  for 
linear  systems.  These  techniques  were  applied  to  two  selected  examples,  a 
single  input  second  order  system  and  a  four  input  fifth  order  system.  The 
implementation  requirements  for  each  system  were  identified  and  a  candidate 
microprocessor  was  selected  as  a  suitable  device  for  implementing  each  of  the 
system  control  and  estimation  algorithms. 


U 


R80-944590-1 


This  report  presents  results  for  the  Phase  II  effort  of  the  program  which 
was  directed  toward  verification  of  the  analytic  procedures  of  Phase  I.  The 
verification  was  conducted  for  both  the  second  order  and  the  fifth  order  cases 
analyzed  in  Phase  1.  The  procedures  involved  simulating  the  system  dynamics  on 
an  EAI/1000  analog  computer.  The  control  and  estimation  dynamics  were  imple¬ 
mented  on  an  Intel  8080  microprocessor  for  the  second  order  case  and  a  Digital 
Equipment  Corporation  LSI-11/2  microprocessor  for  the  fifth  order  case.  Comparisons 
are  presented  between  the  predicted  microprocessor  requirements  and  those 
realized  using  the  hybrid  simulation  approach  mentioned  above. 

The  Phase  I  techniques  have  also  been  extended  to  the  general  class 
of  nonlinear  systems.  An  analysis  is  presented  which  treats  the  nonlinear 
problem  as  a  series  of  linear  problems  by  linearizing  the  dynamics  at  a  set  of 
operating  points.  The  LQG  design  methodology  is  applied  at  each  of  the  operat¬ 
ing  points  to  develop  a  series  of  piecewise  linear  optimal  control  and  estima¬ 
tion  configurations.  The  microprocessor  requirements  for  implementing  this 
approximation  to  the  optimal  nonlinear  solution  are  presented. 
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CONTROL  OF  NONLINEAR  STOCHASTIC  SYSTEMS 


In  this  section  the  general  nonlinear  stochastic  regulation  problem  is 
presented.  The  nonlinear  stochastic  system  model  is  defined  first.  This  model 
is  general  in  nature  -nd  applicable  to  a  broad  class  of  estimation  and  control 
problems. 

A  technique  for  synthesizing  feedback  control  of  the  general  system  is  then 
presented.  The  approach  is  to  represent  the  nonlinear  system  as  a  set  of 
linear  systems  defined  throughout  the  operating  regime  of  the  nonlinear  plant. 
Linear  quadratic  Gaussian  (LQG)  control  design  is  then  reviewed  as  applied  to 
the  linearized  plant  description.  A  technique  for  extending  the  linear  design 
to  the  nonlinear  plant  is  then  presented  which  uses  gain  scheduling  within  the 
controller.  In  the  final  part  ^f  this  section  the  digital  implementation  of 
the  nonlinear  and  linear  controllers  are  discussed. 


System  Description 

The  system  model  is  shown  in  Fig.  1  with  provision  for  estimation  and 
regulation  algorithms  included.  The  system  consists  of  a  nonlinear  plant, 
control  actuators,  and  sensors.  The  control  actuators  are  physical  devices 
which  translate  commanded  inputs  into  actual  plant  inputs.  This  translation  is 
not  exact  and,  therefore,  process  noise  is  included  to  account  for  actuator 
uncertainties.  This  process  noise  also  models  external  plant  disturbances  and 
sys tem-to-system  parameter  variations.  Plant  state  variables  are  generated 
through  plant  dynamics  and  the  actual  inputs.  These  state  variables  in  conjunc¬ 
tion  with  the  actual  inputs  govern  the  plant  output  response.  Plant  state 
variables  are  available  only  through  sensors  which  contain  inherent  lags  and 
nonlinearities.  These  sensors  indicate  which  state  variables  or  combinations 
thereof  can  be  measured.  Sensor  noise  is  included  to  account  for  measurement 
inaccuracies.  Modeling  actuator  and  measurement  uncertainties  by  stochastic 
processes  translates  these  physical  uncertainties  into  mathemat ical ly  tractable 
representations.  The  statistical  properties  of  these  random  processes  define 
the  process  and  sensor  inaccuracies. 

System  dynamics  are  given  by  the  differential  and  algebraic  equations 

x(t)  *  f(x(t),  u (t) ,  £(t) 
y(t)  -  g(x(t),  u ( t) ) 
z(t)  -  h(x(t))  +  n(t) 


i 
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where  x  represents  the  n-dimensional  system  state  vector,  u  represents  the 
m-dimensional  actuator  input  vector,  y  represents  the  p-dimensional  plant 
output  vector,  and  z  represents  the  t -dimensional  measurement  vector.  The 
random  process  vectors  £  snd  r)  represent  white  zero-mean  Gaussian  m-dimensional 
actuator  and  i-dimensional  sensor  noise,  respectively.  The  dot  notation 
denotes  differentiation  with  respect  to  time.  The  vector  functions  f,  g,  and  h 
are  assumed  continuous  and  twice  differentiable  in  all  their  arguments.  Mote 
that  f  includes  all  dynamics  associated  with  the  plant,  actuators  and  sensors. 
The  initial  state  vector  is  assumed  to  be  a  Gaussian  random  variable  with  known 
mean.  The  random  vectors  x(0),  4(t),  and  n(t)  are  assumed  independent  with 
known  covariances.  The  statistics  of  the  system  uncertainties  are  defined 
by 


E{x(0) }  =  x(0) 

E{ (x(0)-x(0)) (x(0)-x(0)) ' }=S(0) 

EU(t)}  =  0 

E{£(t)£'  (t)  }  =  Q(t) <$(t-T ) 

E{n(t) }  *  0  (2) 

E(n(t)n'(T)}  -  R(t)<5(t-T) 

E{(x(0)-x(0)K'(t)}  ■=  0 
E{(x(0)-x(0))n’(t)}  =  0 
EU(t)n'  (t)  }  *  0 


where  6(t-T)  is  the  Dirac  delta  function  and  the  prime  denotes  a  transpose. 


Control  Design  Approach 

The  controller  must  generate  inputs  to  the  actuators  to  achieve  desired  system 
performance  as  determined  by  actual  plant  state  and  output  response.  The  time 
response  of  actual  plant  variables,  rather  than  measured  variables,  is  therefore 
the  key  quantity  that  enters  into  an  assessment  of  system  performance.  The 
controller  must  determine  time  evolution  of  the  actuator  inputs— the  only 
system  variables  which  can  be  directly  adjusted — to  satisfactorily  control  time 
evolution  of  actual  plant  state  and  output  variables. 
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The  nonlinear  stochastic  feedback  regulator  design  depends  on  (1)  the 
dynamics  of  the  system,  (2)  the  levels  of  uncertainty  in  the  system,  and  (3) 
performance  criteria  that  specify  satisfactory  time  evolution  of  the  system 
inputs  and  outputs.  The  design  issue  is  complicated  by  the  interplay  between 
system  dynamics,  the  stochastic  nature  of  the  problem,  and  the  effects  of 
deterministic  commanded  inputs.  However,  a  design  philosophy  that  separates 
the  deterministic  and  stochastic  aspects  of  the  problem  can  be  adopted. 

The  design  approach  involves  first  linearizing  the  system  dynamics  of 
Eq.  1,  applying  linear  quadratic  regulator  (LQR)  control  techniques  to  the 
linear  deterministic  description,  developing  estimator  equations  for  the 
stochastic  portion  and  finally  developing  the  nonlinear  control  by  combining 
the  control  and  estimation  equations. 

The  separation  theorem  (Ref.  17)  allows  optimal  solution  of  the  control 
and  filter  problems  separately  for  linear  systems.  In  general,  if  the  over-all 
nonlinear  quadratic  stochastic  control  problem  could  be  solved,  the  resulting 
optimal  design  would  not  obey  the  separation  property.  Since  at  the  present 
time  the  combined  optimal  nonlinear  estimation  and  control  problem  cannot  be 
solved,  the  separation  concept  and  a  linear  quadratic  Gaussian  approach  is 
employed  to  arrive  at  a  set  of  related  problems  that  can  be  solved. 


Linearized  System  Description 

For  steady-state  regulation,  the  controller  must  maintain  the  actual  plant 
variables  as  close  as  possible  to  the  steady-state  operating  point  in  the 
presence  of  plant  disturbances.  In  these  small-signal  situations,  the  nonlinear 
system  of  Eq.  (1)  ran  be  described  by  a  linearized  perturbational  model  which 
approximates  the  dynamic  behavior  of  the  nonlinear  system  in  a  small  region 
about  the  steady-state  operating  point.  Linear  dynamics  are  determined  by 
expanding  the  nonlinear  system  functions  f,  g,  and  h  (Eq.  (1))  in  a  Taylor 
series  expansion  about  the  steady-state  operating  point  (xgs).  Retaining 
only  first-order  terms  in  the  Taylor  series  expansion  results  in  the  perturba¬ 
tional  equations  of  the  system  dynamics. 

6x(t)  =  A6x(t)  +  B  6u(t)+£(t) 

6y(t)  -  C6x(t)  +  D  <Su(t)  (3) 

6z(t)  =  E6x(t)  +  n(t) 


where  £x,  6u,  6y,  and  6z  represent  state,  input,  output  and  measurement  perturbations, 
respectively,  and  statistical  properties  are  as  previously  defined  for  Eq.  (1).  The 
A  (n  x  n),  B  (n  x  m),  C  (p  x  n),  D  (p  x  m)  and  E  (i  x  n)  matrices  are  given  by 
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A 


11 

3x* 


B 


dh 

3x 


(4) 


evaluated  at  the  point  x  *  xgs 


Deterministic  Control 


A  systematic  technique  for  deterministic  multivariable  nonlinear  system 
control  design  based  on  linear  quadratic  regulator  theory  —  specifically, 
the  piecewise-linear/piecewise-optimal  (PLPO)  control  technique  —  was  developed 
(Ref.  2).  The  deterministic  control  design  procedure  assumes  no  uncertainit ies , 
i.e.,  it  is  assumed  that  (1)  no  actuator  errors  exist,  (2)  no  plant  disturbances 
occur,  (3)  all  state  and  output  variables  are  measured  perfectly,  and  (4) 
actuator  and  plant  dynamics  and  parameters  are  known  exactly.  Under  these 
assumptions,  plant  state  and  output  variables  can  be  determined  for  any  given 
commanded  inputs. 

The  analytical  PLPO  method  is  based  on  linearizing  the  system  about  a 
set  of  closely  spaced  steady-state  operating  points  and  applying  linear  opti¬ 
mization  methods  at  each  point.  A  single  nonlinear  control  problem  is  thereby 
reduced  to  a  series  of  linear  control  problems.  This  permits  the  use  of 
established  analytical  and  numerical  methods  associated  with  linear  quadratic 
control  theory.  At  each  operating  point,  an  optimal  linear  feedback  controller 
is  generated  by  minimizing  a  quadratic  performance  criterion.  Weighting  factors 
within  each  performance  criterion  enable  the  control  designer  to  satisfy 
performance  specifications  by  trading-off  system  response  against  control 
actuation  rates.  Nonlinear  feedback  control  is  then  constructed  by  combining 
the  series  of  linear  controllers  into  a  single  nonlinear  controller  whose 
feedback  gains  vary  with  system  state. 

LQR  theory  applied  at  any  operating  point  given  an  optimal  incremental 
control  for  the  linearized  system  dynamics  described  by  Eq.  3.  The  general  form 
of  this  control  is 


6u*  *  G(x  )  6x 
ss 


(5) 


where  G(m  x  m)  represents  the  optimum  feedback  gain  matrix  for  operation  at 
the  steady-state  point  xgg.  The  PLPO  technique  applied  to  Eq.  3  gives  the 
algorithm  for  implementation  the  nonlinear  control: 
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x(t) 


u* 


G  (x(t))  dx(x)  +  u(0) 


x(0) 


(6) 


Since  the  controller  gain  matrix  G  is  defined  at  a  series  of  design  points 
along  the  system  steady-state  operating  line,  on-line  interpolation  is  used  to 
determine  values  for  G  between  the  operating  points. 


State  Estimation  Design 


The  stochastic  aspects  of  the  problem  are  reintroduced  for  the  estimation 
portion  of  control  system  design.  In  addition  to  plant,  actuator  and  model 
uncertainties,  the  fact  that  all  state  variables  cannot  be  measured  and  that 
any  measurement  is  subject  to  sensor  errors  must  be  taken  into  account.  The 
objective  of  this  step  is  to  design  an  estimator  or  filter  that  generates,  on 
the  basis  of  past  and  present  sensor  measurements,  estimated  plant  state  and 
output  variables  as  close  as  possible  to  actual  plant  state  and  output  variables 
at  any  instant  of  time. 

Linear  filtering  theory  may  be  applied  to  nonlinear  systems  by  continually 
updating  a  linearization  around  the  current  state  estimates.  The  resulting 
estimation  algorithm  is  the  extended  Kalman  filter.  The  system  dynamics  for 
the  extended  Kalman  filter  are  represented  by  the  nonlinear  deterministic 
system  equations.  The  estimated  state  variables  x(t)  and  output  variables 
y(t)  are  generated  by  the  nonlinear  differential  and  algebraic  equations 


x(t)  =  f (x(t) ,  u(t),  0)  +  K(t)  (z(t)  -  h(x(t))) 
y(t)  -  g(x(t),  u(t),  0) 


(7) 


where  the  n  x  i,  Kalman  gain  matrix  K(t)  depends  on  (1)  the  partial  derivatives 
af/dx  and  ah/ax  evaluated  with  respect  to  the  estimated  states  x(t),  and 
(2)  the  sensor  and  driving  noise  statistics.  Extended  Kalman  filtering  theory 
calls  for  the  matrix  K(t)  to  be  calculated  in  real  time  since  it  is  coupled  to 
the  current  state  estimates  through  the  relinearization  procedure.  This 
on-line  gain  calculation  often  results  in  filter  divergence  (kef.  18)  due 
primarily  to  (1)  on-line  linear  system  approximations  required  for  on-line 
gain  calculations,  (2)  model-mismatch  between  the  filter  model  and  the  actual 
system,  and  (3)  mismatch  between  actual  system  noise  statistics  and  those 
statistics  assumed  in  calculating  the  gains.  In  addition,  n(n+l)  differential 
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equations  must  be  solved  to  calculate  the  gain  matrix  H(t).  The  derivation 
is  the  extended  Kalman  filter  is  presented  in  Ref.  17. 

In  Ref.  5  techniques  were  developed  for  large-signal  filtering  logic  with 
off-line  gain  calculation  to  (1)  avoid  the  divergence  problems  associated  with 
on-line  gain  calculation,  and  (2)  reduce  the  computational  complexity  of  the 
filtering  logic.  The  filtering  logic  was  defined  based  on  representing  the 
system  by  reduced-order  models  to  further  reduce  the  computational  complexi  ty 
of  the  estimation  of  algorithms.  In  addition,  model-mismatch  compensation 
techniques  were  established  to  eliminate  bias  errors  due  to  modeling  inaccur¬ 
acies,  sys tem-to-system  variations,  and  system  degradation.  Results  obtained 
in  the  Ref.  3  UTRC  study  directed  toward  stochastic  small-signal  regulation  of 
nonlinear  multivariable  dynamic  systems  indicate  that  Kalman  filtering  methodol¬ 
ogy  with  model-mismatch  compensation  is  an  effective  means  for  achieving 
accurate  estimation.  In  addition,  the  Ref.  3  study  showed  that  improved 
estimation  leads  to  improved  stochastic  regulation. 

Off-line  Kalman  gain  calculation  is  based  on  the  linearized  system  dynamical 
description  of  Eq.  3.  For  this  problem  the  solution  to  the  state  estimation 
problem  found  in  Ref.  17  was  used.  The  Kalman  filter  dynamics  are  described  by 


6x(t)  -  A6x(t)  +  B6u(t)  +  K(z(t)  -  E6x(t)) 
6y(t)  *  C6x(t)  +  D6u(t) 


(8) 


The  n  x  1  constant  gain  matrix  K  is  a  function  of  the  known  A  and  B  matrices 
and  the  specified  system  noise  statistics. 


Model -Mismatch  Compensation 


The  linear  perturbational  model  (Eq.  (3))  represents  an  approximate  relation¬ 
ship  between  state,  input,  output  and  measurement  perturbations  because  second- 
and  higher-order  terms  were  neglected  in  the  Taylor  series  expansion.  Deriva¬ 
tion  of  the  Kalman  gains,  however,  assumes  that  Eq.  (3)  represents  an  exact 
model  of  che  physical  process.  To  compensate  for  this  inherent  model-mi smatch 
an  n  x  1  vector  e,  which  represents  '.he  resulting  error  between  actual  and  esti¬ 
mated  state  perturbations,  is  defined.  This  definition  leads  to  a  second  linear 
estimation  problem  —  i.e.,  estimation  of  the  error  vector  e  —  described  by 


e(t)  -  (-KE+A)e(t)  -  Kn(t)  +  B£(t)  +  v(t) 

v(t)  =  y(t) 

r(t)  -  Ee(t)  +  n(t) 

r(t)  ■  6z(t)  -  E6x(t) 


(9) 
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where  the  n-dimensional  vector  y  represents  white  zero-mean  Gaussian  n- 
d  linens  ion  model-mismatch  uncertainty  with  intensity  N;  i.e.,  E  *y'(t)*V',(T)  ■ 

N(t)<5(t-T) .  The  designer  selects  the  model -mismatch  matrix  N  to  reflect 
uncertainty  about  the  model  dynamics;  i.e.,  the  larger  the  intensity  matrix 
N  the  more  uncertain  the  designer  is  that  the  system  model  is  the  same  as  the 
physical  process.  The  Kalman  filter  for  the  system  described  by  Eq.  (9)  is 
given  by 


e(t)  =  (-KE+A)e(t)  +  v(^t)  +  K^r^-Ee^)) 
•  • 
v(t)  -  K2(r(t)-Ee(t)) 


(10) 


where  the  n  x  (  and  K2  matrices  are  upper  and  lower  partitions,  respect¬ 
ively,  of  the  2n  x  £  Kalman  filter  gain  matrix.  An  improved  perturbational 
state  estimate  is  obtained  by  adding  the  estimated  error  to  the  original 
perturbational  state  estimate.  After  algebraic  manipulation  —  which  alters 
the  Kalman  gains  and  isolates  the  compensator  gains  —  the  estimator  is 
described  by 

6x(t)  -  A6xft)  +  B<5u(t)  +  Kf(Sz(t)-E6x(t))  +  f  (Kc(6z(t)-E6x(t)  )dt  (11) 

o 

where  the  n-dimensional  vector  6  is  the  improved  perturbational  state 
estimate  and 


Kf  -  K  +  K 


K 

c 


(12) 


The  derivation  of  Eq.  (11)  is  presented  in  Ref.  19. 


Integrating  Eq.  (11)  along  the  system  trajectory  leads  to 
.  t 

£(t)  =  f  (x(t)  ,u(t)  ,0)  +  Kf  (z(t)-h(x(t))  +J  Kc(z(T)-h  (x(t))dr 

o 

where 

f  (x(t) ,u(t) ,0)  =  J  (A£x(t)  +  B6u(t))6t 
t  o 

h  *(x (t ) )  =  f  E6x(t ) 6t 
o 


(13) 


(14) 


and  f,  h  represent  the  system  model  employed  in  the  filter.  The  Kalman  and  com¬ 
pensator  gains  Kf  and  Kc  are  functions  of  the  operating  condition.  The  block 
diagram  of  this  filter  is  shown  in  Fig.  2.  The  implementation  requirements  for 
this  nonlinear  filter  depend  on  the  form  assumed  for  the  deterministic  system 
models  f  and  h. 
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The  PLPO  techniques  described  above  and  used  to  generate  the  control  law 
of  Eq.  6  are  now  applied  to  the  filter  equation.  The  procedure  requires 
formulating  expressions  for  the  two  functions  shown  in  Eq.  14.  Path  integrals 
of  the  linearized  system  dynamics  (Eq.  (3))  at  a  series  of  operating  points 
define  the  piecewise-linear  model.  From  Eq.  (3)  the  piecewise-linear  model 
dynamics  are  given  by 


x(t)  ^  u (t) 

f  (x(t) ,u(t) ,0)  *  f  A(x  )dx  +  /  B(x  }du 

x(0)  3  uTO)  3 

(15) 

x(t) 

h  (i(t))  *  f  E  (x  )dl  +  h(x(0))  . 
x(0)  3 

Since  the  A,  B,  C,  D,  and  E  matrices  are  defined  at  a  series  of  design  points 
along  the  system  steady-state  operating  line,  interpolation  based  on  a  selected 
state  x i  is  used  to  determine  values  for  these  matrices  between  design  points. 
The  filter  gains  and  Kc  are  also  functions  of  operating  condition. 

Combined  Estimation  and  Control 


1 

I 

I 

I 


The  third  and  final  step  in  control  synthesis  for  stochastic  nonlinear 
systems  using  the  separation  approach  would  involve  combining  the  PLPO  determin¬ 
istic  control  and  stochastic  estimation  algorithm  developed  in  this  study  into 
a  unified  feedback  controller.  The  resulting  stochastic  controller  must 
estimate  the  system  states  and  outputs  from  the  noise-corrupted  system  measure¬ 
ment  data.  Based  on  these  estimated  system  variables,  the  control  must  generate 
actuator  inputs  to  achieve  satisfactory  system  performance.  The  overall  system 
structure  is  shown  in  Fig.  1. 


Summarizing  the  results  of  the  control  and  filter  design  outlined  above 
produces  the  combined  nonlinear  equation  to  be  implemented 

x(t) 

u(t)  -  j*  G(x(t ) )dx (t )  +  u(0)  (16) 

x(0) 

i(t)  -  f  (x(t) ,u(t) ,0)  +  Kf  (z(t)-h(x(t) ) ) 

(17) 

t 

+  /  K.  (z(t)  -h(x(t)))dT 
o 

where  f,  h  are  defined  in  Eq.  15  for  the  piecewise  linear  model. 
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Digital  Implementation 

The  nonlinear  equations  to  be  implemented  in  the  microprocessor  are  given 
by  Eqs.  16  and  17.  The  implementation  is  based  on  using  rectangular  (Euler) 
integration  which  is  the  simplest  form  of  integration  in  terms  of  the  computa¬ 
tions  required  per  sample  interval. 

To  code  the  estimation  algorithms  on  a  digital  computer  the  filter  equations 
for  state  estimation  may  be  represented  by  (1)  state  prediction  equations,  and 
(2)  state  update  equations.  Filter  equations  based  on  Euler  integration  which 
predict  state  variables  at  time  t  +  at,  given  measurements  to  time  t,  are 
described  by 

x(t  +  At/t)  =  x(t/t)  +  f  (x(t/t) ,u(t) ,0)  At  (18) 


where  At  represents  the  known  sampling  interval.  If  a  more  accurate  integration 
method  (e.g.,  Runge-Kutta)  is  employed,  the  sampling  interval  may  be  increased; 
however,  the  computational  requirements  will  also  be  increased.  The  notation 
(t  +  At/t)  represents  filter  prediction  of  system  states  at  time  t  +  At  given 
measurements  to  time  t.  The  filter  update  equations  are  given  by 


x(t  +  At/t  +  At) 


t+At 

x ( t  +  At/t)  +  (KfAt)r(t  +  At)  +  Y 


(KcAt2)r(T) 


(19) 


r (t  +  At)  -  z(t  +  At)  -  h  (x(t  +  At/t)). 

Equations  (18)  and  (19)  indicate  that  the  state  prediction  computational  require¬ 
ments  are  primarily  dependent  on  the  system  model  in  the  filter;  whereas,  the 
state  update  computational  requirements  are  primarily  dependent  on  the  gain 
calculation.  Output  and  measurement  estimate  computational  requirements  are 
primarily  dependent  on  the  output  and  measurement  models  employed  in  the 
filtering  algorithm.  Therefore,  computational  requirements  for  the  filtering 
algorithms  are  functions  of  (1)  the  system  model  employed  in  the  filter,  and 
(2)  filter  gain  calculation.  Digital  implementation  of  the  control  equation 
follows  from  Eq.  16  again  assuming  Euler  integration 

u(t  +  At)  -  u ( t )  +  G(x^)(x(t  +  At/t  +  At)  — x ( t / t ) )  (20) 


Equation  20  indicates  that  the  control  computational  requirements  are  primarily 
dependent  on  the  gain  calculation.  All  gain  scheduling  is  assumed  to  be 
implemented  using  linear  univariate  interpolation.  For  any  of  the  matrices 
contained  in  Eqs.  18  thru  20  the  algorithm  for  gain  calculation  is 

P  *  m±  (Xj  -  (Xj)t)  +  PA 


tn. 


i+1 


-  P, 


(x.)  -(x  ) 

J  i+1  J  i 
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where  p  denotes  any  matrix  parameter,  and  the  index  i  represents  a  steady-state 
operating  condition  such  that  (Xj)^  Xj  £ 


Microprocessor  Requirements 

The  requirements  placed  on  a  single  microprocessor  to  implement  the  non¬ 
linear  control  and  estimation  equation  are  discussed  in  this  section.  This 
study  did  not  include  an  investigation  of  partitioning  the  computational  tasks 
among  two  or  more  microprocessors  although  this  option  is  a  potentially  powerful 
alternative . 

The  microprocessor  requirements  which  are  discussed  include  (1)  number  of 
computations  required  per  sample  interval  and  (2)  memory  requirements  necessary 
for  storing  the  gains  and  the  sampled  state  values.  The  methodology  closely 
follows  that  developed  in  Ref.  16.  The  number  of  computations  required  per 
sample  interval  determine  the  time  to  execute  the  control  and  filter  equation. 
This  time  must  be  less  than  the  sample  time  which  is  used  in  the  closed  loop 
design.  The  sample  time  in  turn  must  be  sufficiently  fast  to  guarantee  that 
(1)  the  dynamics  of  the  physical  plant  are  adequately  represented  by  the 
sampled  values  and  (2)  the  digital  implementation  of  Eqs.  18  through  20  is 
stable.  A  technique  for  examining  the  stability  of  the  equation  was  presented 
in  Ref.  16.  This  technique  can  be  used  to  study  the  stability  of  these  different 
equations  for  a  particular  system  description.  Guaranteeing  that  the  sample 
update  is  fast  enough  to  adequately  represent  the  nonlinear  dynamics  of  the 
physical  system  requires  that  detailed  simulation  be  used.  For  linear  systems 
the  evaluation  can  be  achieved  without  recourse  to  detailed  simulation  by 
considering  the  eigenvalues  of  the  system.  The  maximum  sample  time  in  this 
case  can  be  determined  by  application  of  the  sampling  theorem. 

Once  the  maximum  sample  time  is  determined  the  applicability  of  a  particular 
microprocessor  can  be  evaluated.  This  evaluation  requires  first  determining 
the  number  of  computations  required  per  sample  interval.  These  computations 
consist  of  signed  multiplication  and  signed  addition  as  well  as  delay  associated 
with  the  input  and  output  operations. 


Computational  Requirements 

The  computational  requirements  for  signed  multiplication  and  signed  addition 
are  determined  from  Eqs.  18  through  21.  This  determination  involves  the  systematic 
analysis  of  these  equations  in  terms  of  the  dimensions  of  the  dynamic  variables 
and  matrices. 

In  Phase  I  it  was  shown  that  the  linear  discrete  controller  implementation 
requirements  could  be  altered  by  transforming  the  estimated  state  vector.  To 
change  state  coordinates  for  the  linear  system  the  estimated  state  vector  x 
is  transformed  through  the  equation 
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w  ■ 


(22) 


where  T  is  an  n  x  n  nonsingular  constant  matrix.  This  technique  was  used  to 
transform  the  system  description  to  both  Jordan  canonical  form  and  the  Companion 
form.  The  digital  implementation  requirements  were  then  evaluated  for  the 
linear  system  in  the  Standard,  Jordan,  and  Companion  forms. 

For  the  transformation  technique  to  be  applicable  to  the  nonlinear  case 
requires  that  a  T  matrix  be  stored  in  the  microprocessor  as  a  function  of 
operating  point.  This  requirement  follows  from  the  fact  that  the  linearized 
system  dynamical  description  of  Eq.  3  is  a  function  of  operating  point. 

Therefore,  for  nonlinear  implementation  additional  memory  is  required  if 
the  transformation  technique  is  to  be  used.  The  approach  taken  in  developing 
the  implementation  requirements  for  the  nonlinear  system  is  to  consider  only  the 
standard  form  of  the  system.  This  avoids  the  necessity  to  store  the  T  matrix 
as  a  function  of  operating  point. 

Filter  computational  requirements  per  sampling  interval  are  determined 
from  the  prediction  and  update  relationship  of  Eqs.  18  and  19.  The  gain 
matrices  and  Kc  are  scheduled  according  to  the  univariate  interpolation 
Algorithm  of  Eq.  21.  The  computational  operations  for  implementing  the  control 
law  of  Eq.  20  consist  of  matrix/vector  multiplication  and  vector  addition  as 
well  as  the  interpolation  required  by  Eq.  21  for  scheduling  the  matrix  G 
between  operating  points. 

In  addition  to  the  operations  associated  with  the  filter  and  control  equa¬ 
tion  there  are  operations  required  for  input  and  output  (I/O)  between  sample 
intervals.  These  operations  consist  of  measuring  l  outputs  of  the  plant  and 
providing  h  inputs  to  the  plant.  These  I/O  operations  are  used  for  both  the 
filter  and  control  equations.  Table  I  summarizes  the  computational  operations 
required  for  each  sample  interval  of  the  PLPO  implementation.  They  consist  of 
multiplications,  additions,  and  I/O  operations.  These  operations  may  be  used  to 
predict  the  computation  time  required  by  the  microprocessor. 

Computational  times  are  evaluated  for  any  candidate  microprocessor  once  the 
benchmark  times  for  signed  multiplication  and  signed  addition  are  determined. 

The  I/O  times  are  dependent  on  the  characteristics  of  the  A/D  and  D/A  converters 
used.  The  characteristics  of  a  representative  set  of  microprocessor  and  A/D  and 
D/A  converters  are  shown  in  Ref.  16  and  repeated  in  Appendix  A. 


Memory  Requirements 


Memory  requirements  depend  upon  (1)  the  system  model  and  (2)  the  computer 
code  including  temporary  storage  to  implement  the  control  and  filter  algorithms. 
System  model  memory  requirements  are  a  function  of  model  structure  as  well  as 
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system  state,  input,  and  output  orders.  System  model  requirements  will  not  vary 
with  microprocessor.  On  the  other  hand,  the  computer  code  and  temporary  storage 
requirements  will  vary  with  microprocessor  as  well  as  system  model. 

Memory  may  be  either  random  access  memory  (RAM)  or  programmable  read  only 
memory  (PROM).  RAM  is  generally  used  to  store  temporary  data  such  as  measure¬ 
ments  and  intermediate  calculations.  PROM  would  be  used  for  storing  constants 
necessary  for  implementing  the  control  and  filter  equations.  Memory  requirements 
are  determined  from  the  filter  and  control  relationships  of  Eqs.  18  through  20 
and  the  interpolation  algorithm  of  Eq.  21.  The  results  are  summarized  in  Table 
II  where  the  type  of  memory,  either  RAM  or  PROM  is  also  indicated.  For  the 
scheduled  gain  matrices,  G,  and  Kc  the  total  number  of  storage  locations 
depends  on  the  number  of  operating  points  used  in  designing  the  PLPO  structure. 

In  Table  II,  R  represents  the  number  of  steady-state  operating  points  selected 
for  system  linearization. 
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LINEAR  SYSTEM  RESULTS 

The  Phase  I  work  reported  in  Ref.  16  dealt  with  the  microprocessor  require¬ 
ments  for  implementation  of  modern  control  for  linear  systems.  A  major  task  con¬ 
ducted  under  the  present  research  was  to  verify  the  analysis  and  prediction  of 
microprocessor  requirements  for  linear  systems.  The  validation  was  aimed  at 
verifying  the  prediction  for  two  problems.  One  problem  was  a  single  input 
second  order  system  and  one  was  a  four  input  five  state  system  respresenting 
linearized  F100  engine  dynamics.  The  second  order  validation  consisted  of 
implementing  the  modern  control  an  Intel  8080  microprocessor.  An  analog 
simulation  of  the  second  order  system  was  interfaced  to  the  microprocessor. 

The  control  for  the  four  input  fifth  order  system  was  implemented  on  a  Digital 
Equipment  Corporation  LSI  11/2  microprocessor.  The  linearized  F100  engine 
dynamics  were  simulated  on  an  Electronics  Associates  Incorporated  Model  1000 
analog  computer. 

This  section  reviews  the  microprocessor  requirements  for  implementing 
modern  control  for  linear  systems.  The  validation  results  are  presented  by 
first  discussing  the  matrix  and  vector  mathematical  algorithms  used  in  the 
microprocessor.  Results  from  this  implementation  phase  are  then  presented  and 
compared  with  the  predictions. 


Microprocessor  Requirements-Linear  Systems 

For  linear  systems  the  matrices  of  Eq.  3  are  constant  and  the  4  notation 
does  not  apply.  Therefore  the  filter  and  control  dynamics  can  be  represented 
by 

• 

x(t)  =  Fx(t)  +  H(z(t)  -  Ei(t)) 

u*(t)  =  Gx(t)  (23) 

F  =  A  +  BG 

where  the  notation  (  )  denotes  the  estimate  of  the  variable  in  parentheses, 

G  (m  x  n)  represents  the  deterministic  feedback  control  gain  matrix  and  H 
(n  x  l)  represents  the  steady-state  Kalman  filter  gain  matrix. 


The  formulation  developed  in  Phase  I  included  provision  for  transforming 
the  coordinate  system  using  a  transformation  matrix  T.  The  reason  for  the 
transformation  is  to  represent  the  system  by  a  new  stste  vector 


w 


T_1  x 


(24) 


whose  dynamic  equation  may  be  of  a  form  to  reduce  the  number  of  computations 
required  in  implementing  the  filter  and  control  equation.  The  transformed 
equations,  from  Eqs.  23  and  24  are 


v(t)  -  F?w(t)  +  Ht  ( z (t )  -  ETw(t)) 


(25) 


u(t) 


GTw(t) 


18 


R80-944590-1 


where  *  T~*(F)T,  Hj  *  T”^H,  E^.  *  ET  and  GT  *  GT.  However,  the 

matrix  F^,  depend?  upon  the  selected  transformation  matrix  T.  Note  that  T*I 

results  in  the  standard  form,  i.e.,  FTBF. 


Implementing  the  control  and  estimation  dynamics  of  Eq.  25  is  done  by 
solving  the  filter  equation  in  two  steps  as  discussed  earlier.  This  process 
involves  solving  (1)  state  prediction  equations  and  (2)  state  update  equations. 
The  result  may  be  expressed  in  the  following  form 


where 


w(k  +  1)  *  (J>D  w(k)  +  Hd  z  (k  +  1) 
u(k  +  1)  =  G  w(k  +  1) 

♦D  -  (I  -  T-1  HETAt)  (I  +  4>) 

*  .  T'1  FT4t  +  XT'Wat3 

-1  2!  3! 

Hq  =  T  1  HAt 


(26) 


(27) 


Gd  -  GT 

and  k  denotes  the  kth  sample  time. 


The  matrices  of  Eq.  27  are  computed  off-line  and  stored  in  the  microprocessor 
for  use  in  implementing  the  filter  and  control  relationships  of  Eq.  26. 


Analytic  techniques  were  established  in  Phase  I  for  predicting  the  micro¬ 
processor  requirements  for  implementing  Eq.  26.  The  specific  requirements 
addressed  included  (1)  accuracy  (word  length)  requirements,  (2)  computational 
requirements,  and  (3)  memory  requirements. 


Accuracy  Requirements 

The  effect  of  finite  word  length  on  the  overall  response  of  the  controlled 
system  was  evaluated  using  a  performance  index  approach.  A  Univac  1100  series 
digital  computer  with  a  36  bit  word  length  was  used  to  generate  system  response 
against  which  the  responses  for  smaller  word  length  configuration  could  be 
compared.  The  performance  index 

J  m  f  [  (y*  -  yt)'  Q(y*  -  yt)  +  (u*  -  ut)'  R(u*  -  ut)]dt 

J  (28; 

o 

where  y  =  output  response  vector  with  36-bit  controller 
y*  =  output  response  vector  with  b-bit  controller 

•fc 

u  *  control  vector  with  36-bit  controller 
U+  *  control  vector  with  b-bit  controller 
Q,R  ■  weighting  matrices 


was  defined.  The  performance  index  J  represents  performance  degradation  due  to 
finite  word  lengths  less  than  the  accurate  36-bit  word  length.  As  the  number 
of  bits  in  the  computer  word  approaches  36,  J  approaches  zero. 
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A  procedure  was  developed  for  reducing  this  integral  equation  to  an 
algebraic  equation.  The  resulting  expression  allows  the  numerical  evaluation 
of  Eq.  28  to  be  performed  very  simply  on  the  computer  without  the  need  to 
simulate  the  actual  system,  control,  and  filter  dynamics. 

Computational  Requirements 

The  computational  requirements  for  implementing  Eq.  26  were  expressed  in 
terms  of  the  number  of  multiplications,  and  additions  required  as  well  as  the  1/0 
operations  required  for  each  sample  interval.  Three  cases  were  considered 
corresponding  to  three  tranformation  matrices  T,  defined  in  Eq.  25.  The  three 
structures  were  (1)  Standard,  (2)  Jordan  canonical,  and  (3)  Companion.  Table 
III  summarizes  the  results  for  the  number  of  operations  required  for  the  LQG 
implement  at  ion. 

Memory  Requirements 

Total  storage  requirements  were  defined  for  the  filter  and  control  dynamics 
represented  by  Eq.  26.  The  memory  requirements  resulted  from  analysis  of  the 
dimension  of  the  vectors  and  matrices  of  Eq.  26.  The  storage  was  required  for 
(1)  past  state  estimates,  w(k),  (2)  current  state  estimates,  w(k+l),  (3) 
measurements  z(k+l),  (4)  control  u(k+l),  and  the  gain  (Gp)  and  filter  matrices 
(<frD,  Hd)  of  Eq.  26. 

The  memory  requirements  for  implementing  LQG  control  and  estimation  are 
summarized  in  Table  IV  for  the  three  system  structures  discussed  above. 
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APPLICATION  AND  VERIFICATION  OF  MICROPROCESSOR 
REQUIREMENT  PROCEDURES 


The  procedures  reviewed  in  the  previous  section  were  applied  to  two  can¬ 
didate  systems  and  the  microprocessor  requirements  were  predicted.  The  systems 
selected  for  examination  were  (1)  a  single  input  second  order  plant  and  (2)  a 
four  input  fifth  order  F100  turbofan  engine  linearized  at  sea  level  static 
military  operation.  The  verification  of  the  procedures  was  carried  out  for 
both  of  the  selected  examples.  This  verification  consisted  of  (1)  simulating 
the  system  dynamics  on  an  analog  computer,  (2)  implementing  (coding)  the 
control  and  filter  equation  in  a  microprocessor,  and  (3)  comparing  the  results 
with  those  predicted  using  the  procedures  discussed  above. 

Before  discussing  the  results  of  the  validation  experiments  it  is  important 
to  describe  the  matrix  and  vector  operations  which  are  required  to  implement  the 
control  and  filter  dynamics  of  Eq.  26.  The  operations  required  i.e.,  vector/ 
matrix  multiplication  and  vector  addition  are  generic  to  the  structure  of  the 
problem.  Any  efficiencies  which  can  be  realized  in  performing  these  operations 
will  translate  directly  into  reduced  computational  time. 

A  block  diagram  of  the  complete  simulation  system  is  shown  in  Fig.  3.  The 
system  dynamics  are  simulated  on  an  analog  computer.  Control  and  filter  dynamics 
are  implemented  in  a  microprocessor  which  is  interfaced  to  the  analog  computer 
using  A/D  and  D/A  converters  as  shown. 

The  software  to  implement  the  control  and  f ilter^dynamics  consists  of 
three  matrix^vector  multiplications  ($Dw,  H^z ,  and  GpW)  and  one  vector 
addition  (  <I>j_jW  +  H^z)  Other  operations  are  required  to  save  past  state  esti¬ 
mates,  service  the  clock,  interrupt  and  output  the  control  via  the  D/A  converter. 
The  clock  interrupt  service  routine  (1)  performs  a  timing  check  to  assure  that  all 
control  computations  are  completed  within  the  sample  time  and  (2)  reads  in 
measurement  data  via  the  A/D  converter. 

The  overall  block  diagram  of  the  control  software  described  above  is  shown 
in  Fig.  4.  The  block  diagram  of  the  matrix/vector  multiplication  code  is 
displayed  in  Fig.  5.  Figure  5  includes  several  minor  changes  (e.g.,  the  order 
in  which  pointers  are  initialized  and  updated)  which  were  made  in  the  matrix/ 
vector  multiplication  block  diagram  presented  in  the  Phase  I  report.  These 
changes  result  in  more  efficient  microprocessor  implementation.  The  matrix/vector 
multiplication  algorithm  is  not  changed  but  rather  the  way  the  algorithm  is 
implemented  has  been  slightly  modified,  block  diagrams  of  the  vector  addition 
code,  the  store  state  estimates,  and  the  interrupt  service  routine  are  shown  in 
Fig.  6. 
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Second  Order  System 

The  second  order  system  dynamics  in  the  form  of  Eq.  3  are  represented  by 
the  A,  B,  C,  D  and  E  matrices  of  Table  V.  The  control  and  filter  dynamics  for 
the  second  order  system  are  in  the  form  of  Eq.  26.  The  constant  matrices 
and  HD  are  also  shown  in  Table  V. 

The  second  order  system  control  and  filter  equations  were  coded  on  an  Intel 
8080  microprocessor  with  software  multiply.  The  second  order  system  dynamics 
were  implemented  on  a  special  purpose  analog  computer. 

The  improvements  discussed  above  in  the  matrix/vector  multiplication  algor¬ 
ithms  were  incorporated  into  the  8080  code.  These  improvements  result  in 
reduced  execution  time.  The  code  changes  include  (1)  more  efficient  use  of  the 
registers  in  the  multiplication  algorithm  (11.3%  reduction  in  cycle  time)  and 
(2)  more  efficient  memory  (data  array)  accessing  as  well  as  more  efficient  use 
of  the  registers  in  the  matrix/vector  multiplication  algorithm  (reduction  in 
cycle  time  dependent  on  system  order,  e.g.,  a  24%  reduction  in  the  matrix/vector 
multiplication  control  algorithm  is  obtained  for  a  2  x  2  matrix  times  a  2  x  1 
vector).  In  addition,  the  interface  software  was  added  to  the  preliminary 
code.  A  complete  listing  of  the  code  is  shown  in  Appendix  B. 

Comparison  of  Results 

The  analytic  procedures  developed  in  Ref.  16  were  applied  to  the  second 
order  system.  Conclusions  resulting  from  applying  these  prediction  techniques 
were  (1)  an  8  bit  word  length  is  sufficient,  (2)  a  minimum  sample  time  based  on 
the  number  of  computations  of  4.25  ms  was  predicted  for  the  8080,  and  (3)  490 
words  of  memory  would  be  required. 

The  validation  of  the  prediction  techniques  consisted  of  (1)  comparing  the 
execution  times  and  memory  requirements  between  the  predicted  values  and  those 
resulting  from  the  actual  implementation  and  (2)  comparing  dynamic  response 
between  that  predicted  and  that  actually  achieved.  This  dynamic  response 
comparison  was  used  to  verify  the  accuracy  requirement  predictions. 

Table  VI  summarizes  the  predicted  values  for  computation  time  and  memory 
requirements  and  also  shows  the  computation  time  and  memory  actually  achieved 
with  the  implemented  system.  The  minimum  predicted  sample  time  of  4.25  ms 
compares  well  with  the  measured  value  of  4.7  ms. 

The  actual  memory  requirements  are  also  in  good  agreement  with  the  pre¬ 
dicted  values.  Actual  memory  used  was  483  words  of  which  468  were  PROM  and  15 
were  RAM.  The  predicted  values  were  490  words  including  15  words  of  RAM  and 
475  words  of  PROM. 
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Validation  of  the  word  length  requirements  shows  that  the  prediction  tech* 
niques  are  quite  accurate.  This  is  important  since  the  word  length  prediction 
was  treated  using  an  analytic  formulation  based  on  the  cost  function  approach 
described  above.  This  allows  the  designer  to  simply  solve  an  algebraic 
matrix  equation  to  assess  the  effect  of  finite  word  length.  Application  of 
this  technique  to  the  second  order  system  showed  that  an  8  bit  microprocessor 
was  adequate  for  implementing  the  second  order  control  and  filter  equations. 

An  8  bit  microprocessor  was  simulated  as  described  in  Ref.  16  and  the  resulting 
output  response  was  recorded.  Figure  7  shows  this  predicted  response  and  also 
shows  the  response  recorded  using  the  analog  computer/8080  system.  The  good 
agreement  between  these  results  indicate  that  the  prediction  techniques  are 
valid  for  assessing  the  effect  of  word  length  on  system  response. 

Fifth  Order  System 

Validation  of  the  prediction  techniques  was  also  carried  out  for  a  four 
input  fifth  order  linear  system.  The  system  dynamics  represent  the  linearized 
description  of  an  F100  turbofan  engine  operating  at  sea  level  static  military 
operating  conditions.  The  linearized  engine  dynamic  description,  in  the  form 
of  Eq.  3  are  represented  by  the  A,  B,  C,  D  and  E  matrices  of  Table  VII. 

Simulating  these  dynamics  on  the  EA1  1000  analog  computer  requires  imple¬ 
menting  the  A  and  B  matrices  of  Table  VII.  The  number  of  amplifiers  and 
potentiometers  required  for  instrumenting  the  matrices  as  shown  exceeded  the 
number  available  on  the  EAI  1000.  The  large  number  of  analog  computer  components 
required  is  a  result  of  the  A  and  B  matrices  being  in  standard  form  i.e.,  all 
elements  of  the  matrices  were  nonzero.  An  attempt  was  made  to  transform  the 
system  description  to  both  the  Jordan  canonical  form  and  the  Companion  form  by 
using  the  appropriate  T  matrix  transformation  as  described  in  Eq.  24.  This 
approach  did  not  work,  however,  since  the  resultant  closed  loop  F^  matrix  of 
Eq.  24  became  ill  conditioned.  That  is,  the  magnitude  of  the  elements  of  FT 
varied  over  a  wide  range.  This  wide  range  of  values  in  turn  required  more  than 
16  bits  of  accuracy  to  allow  stable  closed  loop  operation.  The  number  of 
analog  components  required  was  reduced  by  eliminating  several  of  the  smallest 
terms  in  the  A  and  B  matrices  and  approximating  other  terms.  The  resultant  A 
and  B  matrices  are  shown  in  Table  VIII.  These  matrices  are  compatible  with  the 
number  of  components  available  on  the  EAI  1000.  Since  the  control  (Gp)  and 
filter  matrices  (Hp,  4p)  of  Eq.  26  are  dependent  on  the  A  and  B  matrices, 
new  values  for  these  matrices  were  computed  for  the  modified  A  and  B  matrices. 

The  matrix  values  for  Gp,  Hp,  and  $p  are  shown  in  Table  IX.  These  values 
are  those  used  m  the  microprocessor  implementation. 

The  modified  system  dynamics  were  required  to  allow  analog  computer  imple¬ 
mentation.  However,  to  verify  that  the  changes  did  not  significantly  affect 
the  dynamic  description  of  the  system  a  comparison  was  made  between  the  responses 
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for  Che  original  A  and  B  matrices  and  modified  versions.  Figure  8  depicts  the 
close  agreement  between  the  two  cases  for  the  Xj  state  (incremental  fan 
turbine  inlet  temperature)  response.  Other  results  which  were  obtained  show 
similar  agreement  and  it  was  concluded  that  changing  the  A  and  B  matrices  did 
not  noticeably  alter  the  closed  loop  dynamics. 

Prior  to  implementing  the  closed  loop  experiment  the  analog  simulation  was 
checked  against  the  expected  response  to  verify  that  the  analog  representation 
was  correct.  This  was  done  by  comparing  the  unforced  (u*o)  response  of  the 
analog  system  against  a  digital  computer  simulation.  This  procedure  was  of 
considerable  value  in  uncovering  and  correcting  wiring  errors  on  the  analog 
computer.  The  analog  computer  implementation  is  shown  in  Fig.  9.  The  analog 
simulation  of  the  unforced  system  compares  well  with  the  digital  simulation. 
Figure  10  compares  the  x^  state  (incremental  after  burner  pressure)  responses. 

Microprocessor  Implementation 


Based  on  application  of  the  prediction  techniques  it  was  decided  to  use 
an  LSI-11  16  bit  microprocessor  with  hardware  multiply  and  divide  options.  The 
matrix/vector  operation,  the  interrupt  service  routines  and  the  state  store 
algorithm  discussed  previously  and  shown  by  the  flowcharts  of  Figs  4,  5,  and  6 
were  coded  on  the  LSI-11.  Several  changes  were  incorporated  into  the  final 
version  of  the  code  compared  to  the  preliminary  code  developed  during  Phase  I. 
Three  changes  were  in  the  areas  of  (1)  maximizing  the  use  of  registers  to 
reduce  the  memory  access  times  and  (2)  improving  the  techniques  for  table 
accessing.  Additionally,  since  the  hardware  multiply  and  divide  option  of  the 
LSI-11  are  for  unsigned  operations,  code  was  developed  to  enable  the  handling 
of  signed  operations.  The  complete  code  for  the  LSI-11  implementation  is  shown 
in  Appendix  C. 

Comparison  of  Results 

Comparisons  are  presented  for  (1)  accuracy  requirements,  (2)  computational 
speed,  and  (3)  memory  requirements.  In  each  case  the  comparison  is  made  between 
the  resulted  predicted  using  the  techniques  of  Phase  I  and  the  results  obtained 
from  the  actual  implementation.  Application  of  the  prediction  techniques  indi¬ 
cate  that  the  fifth  order  system  can  be  implemented  for  the  standard  structure 
of  the  system  using  (1)  16  bit  word  length,  (2)  a  minimum  sample  time  of  9.68 
ms  based  on  the  computational  requirements  and  (3)  304  words  of  memory  (183 
words  of  PROM  and  121  words  of  RAM). 

The  predicted  results  for  a  simulated  16  bit  word  length  are  compared 
against  results  from  the  EAI  1000/LSI-ll  system.  The  predicted  results  were 
obtained  by  using  the  Phase  I  simulation  techniques  and  the  modified  system 
dynamics  discussed  above. 
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Accuracy  requirements  are  compared  as  in  the  second  order  case  by  examining 
the  dynamic  responses.  Figure  11  shows  the  predicted  response  of  the  F100 
engine  model  perturbat ional  afterburner  pressure  response  (x^)  and  the 
response  obtained  from  the  hardware  implementation.  Additional  comparisons  are 
shown  in  Figs.  12  through  14.  Figure  12  compares  the  small  signal  fan  speed 
response  and  Fig.  13  shows  the  small  signal  fan  turbine  inlet  temperature 
response.  Figure  14  compares  the  compressor  variable  vane  (u^)  control  The 
agreement  between  the  predicted  and  actual  responses  is  good  considering  that 
the  voltage  levels  of  the  responses  on  the  analog  computer  were  100  mV  and 
less.  There  low  levels  were  required  to  keep  the  maximum  voltage  levels  in  the 
analog  simulation  below  the  5  volt  power  supply  limit  of  the  computer.  These 
low  voltage  levels  result  in  a  lower  signal  to  noise  ratio  at  the  outputs  of 
the  A/D  converters  than  would  be  possible  with  higher  signal  levels.  This 
noise  represents  measurement  noise  analogous  to  the  n(t)  term  in  the  definition 
of  the  system  dynamics  of  Eq.  3.  The  optimal  estimator  gains  calculated  for 
the  fifth  order  system  were  predicted  on  a  noise  covariance  of  0.01.  The 
actual  noise  present  in  the  analog  simulation  was  beyond  the  control  of  the 
experiment  and  therefore  the  precalculated  gains  are  not  optimal  for  the  analog 
system  noise  levels.  With  this  proviso,  however,  it  can  be  concluded  that  the 
agreement  between  the  predicted  responses  and  the  actual  responses  is  good. 

This  validates  the  conclusion  that  a  16  bit  word  is  adequate  for  the  fifth 
order  system  and  indicates  that  the  accuracy  prediction  techniques  developed  in 
Phase  1  are  applicable. 

Computational  requirements  as  predicted  by  the  Phase  I  techniques  were  9.68 
ms  to  perform  the  control  and  filter  calculations.  This  time  consisted  of  8.23 
ms  for  arithmetic  calculation  and  1.45  ms  for  input  and  output  operations.  The 
computation  time  for  the  experiment  was  determined  using  a  frequency  counter. 

The  time  required  to  execute  the  code  was  14.45  ms  and  the  input  and  output 
operations  required  1.32  ms.  The  total  time  between  samples  required  by  the 
system  was  therefore  15.77  ms.  The  large  discrepancy  (15.77  ms  vs  9.68  ms)  is 
due  to  the  nature  of  the  hardware  multiply  instruction.  The  Phase  I  estimate 
of  the  time  required  for  a  multiply  was  40.5  ps.  However,  this  figure  was  in 
error.  The  actual  time  required  in  the  LSI-11  for  a  hardware  multiply  ranges 
from  a  low  value  of  37.0  ms  to  a  maximum  of  68.0  ms.  The  exact  value  for  a 
multiply  depends  on  the  value  of  the  two  numbers  being  multiplied.  In  addition, 
the  Phase  I  prediction  did  not  account  for  the  additional  software  required  to 
achieve  a  signed  multiplication.  This  added  software  increases  the  multiply 
time  to  161  ps  on  the  LSI-11.  Since  there  are  70  multipliers  required  per 
sample  interval  the  Phase  I  estimate  was  in  error  by  8.43  ms  which  is  the 
difference  between  the  actual  multiply  time  of  161  ps  and  the  Phase  1  time  of 

40.5  ps  times  the  70  multiplication  required.  Using  the  correct  value  of  161 
ps  and  applying  the  Phase  1  prediction  techniques  results  in  a  total  time  of 

16.6  ms.  This  figures  compares  well  with  the  measured  time  of  15.77  ms. 
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Table  X  summarizes  the  comparison  between  the  predicted  computation  times 

and  those  determined  in  the  equipment.  This  table  shows  the  originally  predicted 

times  which  did  not  account  for  the  additional  multiply  software  and  the  values 
predicted  after  the  additional  software  was  involved  in  the  analysis.  Table  X 
also  shows  the  predicted  and  actual  memory  requirements  for  the  fifth  order 
system. 

Memory  requirements  as  predicted  using  the  Phase  I  methods  were  304  16  bit 
words  of  which  121  words  would  be  RAM  and  183  would  be  PROM.  The  actual  LSI-11 
memory  requirements  are  422  words  of  which  109  words  are  RAM  and  313  words  are 

PROM.  The  reduction  in  the  number  of  RAM  words  required  (109  compared  to  121) 

is  a  result  of  the  efficient  use  of  resisters  for  temporary  storage.  The 
increase  in  PROM  in  the  experiment  (313  compared  to  183)  was  due  primarily  to 
the  software  required  for  implementing  the  signed  multiply  and  divide  operations 
(46  words  required)  and  the  scaling  routines  necessary  to  interface  with  the 
D/a  converters  (55  words). 

Table  X  shows  the  memory  requirements  using  the  original  prediction 
techniques,  updated  prediction  techniques  and  those  actually  required.  The 
original  prediction  values  were  updated  to  include  the  additional  memory  re¬ 
quired  to  store  the  code  for  implementing  the  signed  multiply  and  divide 
routines  (46  words)  and  the  scaling  software  required  (55  words)  to  interface 
to  the  D/A  converters.  Both  of  these  operations  are  in  the  category  of  program 
code  rather  than  storage  required  for  the  basic  LQG  structure.  These  additional 
requirements  result  from  the  specific  characteristics  of  the  microprocessor 
used.  In  general  there  is  no  effective  way  to  predict  the  additional  memory  (or 
computation  time)  without  detailed  consideration  of  the  particular  microprocessor. 

In  the  Phase  I  effort  it  was  concluded  that  the  memory  required  to  implement 
LQG  control  on  microprocessors  was  modest.  Although  the  experiment  summarized 
above  did  reveal  that  additional  memory  is  required,  the  increase  is  small  and 
the  conclusion  that  memory  requirements  are  not  significant  is  unchanged.  The 
caution  to  be  exercised  in  predicting  requirements  is  that  subtle  characteristics 
of  the  particular  microprocessor  selected  for  the  application  should  be  con¬ 
sidered  in  arriving  at  detailed  estimates. 

In  summary,  the  Phase  I  technique  for  analytically  predicting  word  length 
requirements  agrees  very  well  with  the  actual  results  of  the  validation.  The 
techniques  for  estimating  computational  requirements  and  memory,  once  updated  to 
account  for  particular  microprocessor  characteristics  (i.e.,  multiply  times  for 
signed  operations)  were  found  to  produce  good  estimates  for  the  actual  requirements. 
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LIST  OF  SYMBOLS 

A  Constant  n  x  n  matrix  in  linear  system  dynamic  description 

B  Constant  n  x  m  matrix  in  linear  system  dynamic  description 

C  Constant  p  x  n  matrix  in  linear  system  dynamic  description 

D  Constant  p  x  m  matrix  in  linear  system  dynamic  description 

E  Constant  t  x  n  matrix  in  linear  system  dynamic  description 

e  n  x  1  error  vector  used  to  represent  bias  errors  due  to  model 

mismatched  Kalman  filter 

F  Constant  n  x  n  matrix  used  to  describe  optimal  deterministic 

closed  loop  system  dynamics 

Ff  Constant  n  x  n  matrix  used  to  describe  transformed  optimal 

closed  loop  system  dynamics 

f  Nonlinear  n  x  1  vector  function  describing  rate  of  change  of  system 

state  vector 

G  Constant  m  x  n  optimal  deterministic  closed  loop  feedback 

gain  matrix 

GD  Constant  m  x  n  optimal  deterministic  closed  loop  feedback 

gain  matrix  for  microprocessor  implementation 

g  Nonlinear  p  x  1  vector  function  describing  system  output  vector 

H  Constant  n  x  l  Kalman  filter  gain  matrix 

Hq  Constant  n  x  f  Kalman  filter  gain  matrix  for  microprocessor 

implementation 

h  Nonlinear  i  x  1  vector  function  describing  measurement  vector 

I  Identity  matrix 

i  General  subscript 

J  Performance  index 
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LIST  OF  SYMBOLS  (Cont *d) 


Number  of  operating  points  used  in  linearizing  nonlinear  system 

n  x  i  compensator  gain  matrix  for  estimator  with  model  mismatch 
compensat ion 

n  x  i  Kalman  filter  gain  matrix  for  estimator  with  model  mismatch 
compensat ion 

Discrete  time 

Dimension  of  system  measurement  vector  z 
Dimension  of  system  control  vector  u 
Dimension  of  system  state  vector  x 
Dimension  of  system  output  vector  y 
Constant  p  x  p  matrix  used  in  J 
Constant  m  x  m  matrix  used  in  J 
Random  access  memory 
Programmable  read  only  memory 
Constant  n  x  n  transformation  matrix 
m  x  1  control  vector 
m  x  1  optimal  control  vector 
n  x  1  transformed  state  vector 
n  x  1  system  state  vector 
p  x  1  system  output  vector 
l  xl  system  measurement  vector 
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LIST  OF  SYMBOLS  (Cont'd) 

n  l  x  1  sensor  noise  vector 

5  m  x  1  process  noise  vector 

4  Constant  n  x  n  closed  loop  system  matrix 

*D  Constant  n  x  n  closed  loop  system  matrix  used  in  microprocessor 

implementation 

6  (  )  Small  signal  (linearized)  representation  of  variable 
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TABLE  I 

COMPUTATIONAL  REQUIREMENTS 
PLPO  Implementation  -  Standard  Structure 


Function 

Application 

Number  of  Operations 

Addition 

Filter 

n(n-l+5P) 

Control 

n(m+l) 

Multiplication 

Filter 

n^+3ni 

Control 

n(nrK) 

Interface 

Input 

m 

Output 
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TABLE  II 

MEMORY  REQUIREMENTS 
PLPO  Implementation 


Variable 

Memory 

Type 

Number  of 

Locations 

Past  state 

estimate  (x(t  +  At/t)) 

RAM 

n 

Current  state 

estimate  (x(t  +  At/t  +  At) 

RAM 

n 

Measurement  (z(t  +  At)) 

RAM 

£ 

Control  (u(t  +  At)) 

. 

RAM 

fll 

Control  matrix  G 

PROM 

gn2 

Kalman  matrix  K 


Kalman  matrix  K 


f 


PROM 


KnJ 


Knit 


PROM 
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TABLE  VI 

COMPARISON  OF  PREDICTED  AND  ACTUAL  COMPUTATION  TIME  AND  MEMORY 

Second  Order  System 
Intel  8080  Microprocessor 


Computation  time  -  msec 

Memory  Requirements  -  byte 

RAM 

PROM 

Prediction 

4.25 

15 

475 

Actual 

4.70 

15 

468 
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TABLE  VII 


FIFTH-ORDER  FlOO  ENGINE  MODEL  DYNAMICS 


Engine  Model  Linearized  at  Sea-Level  Static  Military  Operation 


States 


Outputs 


Controls 


Fan  turbine  inlet  temperature  Airflow 


Main  burner  pressure 
Fan  speed 
Compressor  speed 
Afterburner  pressure 


Matrix 


Fan  stability  margin 
Compressor  stability  margin 
Thrust 

High  Turbine  inlet  temperature 


Jet  exhaust  area 
Fan  inlet  guide  vanes 
Compressor  variable  vanes 
Main  burner  fuel  flow 


Matrix 

Elements 

-34.013 

-9.303 

12.037 

-2.398 

-1.254 

4.389 

-38.762 

-4.221 

28.480 

14.729 

-4.755 

2.287 

-0.400 

-1.546 

-2.200 

2.046 

1.062 

-0.729 

-2.150 

-0.624 

4.150 

-8.814 

-0.167 

7.477 

1.099 

0.156 

-0.136 

-4.729 


-0.101 

0.073 


»  -0.813 

17.095 

7.737 

8.641 

>  -0.416 

2.034 

i  -0.555 

-0.378 

►  1.617 

0.223 
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TABLE  VIII 

APPROXIMATE  FIFTH-ORDER  F100  ENGINE  MODEL  DYNAMICS 

A,  B  matrices  represent  approximations  to  those  in  Table  VII 
which  are  required  to  allow  EAI  1000  analog  computer  Implementation 


Matrix 


Matrix  Elements 


-34.013 

-9.0 

12.037 

-2.2 

0.0 

4.4 

-38.762 

-4.221 

28.480 

14.729 

A 

-4.4 

2.287 

0.0 

-1.546 

-2.200 

2.046 

1.062 

-0.729 

-2.2 

-0.8 

4.4 

-9.0 

0.0 

7.477 

0.8 

0.0 

0.0 

0.0 

17.095 

0.0 

1.2 

7.737 

8.641 

B 

0.14 

-1.2 

-0.5 

2.034 

-0.14 

0.0 

-0.5 

-0.378 

-4.729 

0.874 

1.617 

0.0 
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TABLE  X 


COMPARISON  OF  PREDICTED  AND  ACTUAL  COMPUTATION  TIMES  AND  MEMORY 

Fifth  Order  System 
LSI  11/2  Microprocessor 

Updated  Prediction  Accounts  for  Additional  Multiply  Software 


Computation  Time  -  msec 

Memory  Requirements  -  Words 

RAM  PROM 

Original  Prediction 

9.68 

121 

183 

Updated  Prediction 

16.6 

121 

284 

Actual 

15.77 

109 

313 

41 
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CONTROL  CODE  BLOCK  DIAGRAM 


£  START  ^ 

|  INITIALIZE  | 

MATRIX/VECTOR 
MULTIPLY  1 

MM1  =  H0Z 

MATRIX/VECTOR 
MULTIPLY  2 

MM2  =  <j>D  u> 

VECTOR 

ADD 

<£(K+1)  =  MM2  +  MM1 

STATE  STORE 

W(K)  =  w(K  +  1) 

MATRIX/VECTOR 
MULTIPLY  3 

MM3  =  Gd<I» 

_ _ i _ 

UPDATE 

INPUTS 

INTERRUPT  SERVICE 
ROUTINE 


(1)  TIMING  CHECK 

(2)  READ  IN  MEASUREMENT 
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BLOCK  DIAGRAM  FOR  MATRIX/VECTOR  MULTIPLICATION 


FIG.  5 


p(q  X  1*  =  M(qXi)v(r  X  1) 


S'  = 
^mO 

?T11 


time  to  EXECUTE  BLOCK  3 
»  TIME  TO  EXECUTE  BLOCKS  t  8 
»  TIME  to  EXECUTE  BLOCKS  I  5  6 
=  TIME  to  EXECUTE  BLOCKS  2  7 
time  to  EXECUTE  BLOCK  10 
=  TIME  to  EXECUTE  BLOCK  1 1 
s  TIME  TO  EXECUTE  BLOCKS  9  '!  <  3 
*  TIME  TO  EXECUTE  BLOCK  14 
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FIG. 

BLOCK  DIAGRAM  FOR  VECTOR  ADDITION,  STATE  STORE  AND  INTERRUPT  SERVICE 


TC  =  TIME  TO  EXECUTE  BLOCK  1 
£5  =  TIME  TO  EXECUTE  BLOCK  2 
=  TIME  TO  EXECUTE  BLOCK  3 
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COMPARISON  OF  PREDICTED  AND  ACTUAL  SECOND  ORDER  OUTPUT  RESPONSE 

RESPONSE  TO  INITIAL  CONDITION  XQ  =  (0  5,  0.5) 

STANDARD  STRUCTURE  WITHIN  CONTROLLER 
1  =  0  1  sec.  WORD  LENGTH  =  8  BITS 


REAL  TIME  ANALOG  SYSTEM/DIGITAL  MICROPROCESSOR  CONTROL 
SIMULATED  ANALOG  SYSTEM/SIMULATED  MICROPROCESSOR  CONTROL 
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FIG.  8 


F100  ENGINE  MODEL  FAN  TURBINE  INLET  TEMPERATURE  RESPONSE 

ORIGINAL  A&B  MATRIX  vs  MODIFIED  A&B  MATRIX 
INITIAL  CONDITION  X  =  0  1 
At  =  0  025  sec.  WORD  LENGTH  =  1 6  BITS 


—  ORIGINAL  MATRIX  RESPONSE.  UNIVAC  SIMULATION 

- MODIFIED  MATRIX  RESPONSE.  UNIVAC  SIMULATION 
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FIFTH  ORDER  ENGINE  ANALOG  SIMULATION 
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F100  ENGINE  MODEL  AFTER  BURNER  PRESSURE  RESPONSE 

UNIVAC  SIMULATED  RESPONSE  vs  ANALOG  COMPUTER  RESPONSE 
INITIAL  CONDITIONS  X  =  0  1 
t  =  0  025  sec.  WORD  LENGTH  =  16  BITS 


UNIVAC  SIMULATED  RESPONSE 
ANALOG  COMPUTER  RESPONSE 
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F100  ENGINE  MODEL  FAN  SPEED  RESPONSE 
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FIG.  13 


F100  ENGINE  MODEL  FAN  TURBINE  INLET  TEMPERATURE  RESPONSE 
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APPENDIX  A 


MICROPROCESSOR  SURVEY 


Characteristics  of  (1)  microprocessors,  (2)  A/D  and  D/A  converters,  and 
(3)  hardware  multipliers  are  presented  in  this  Appendix.  The  characteristics 
tabulated  here  were  obtained  from  Electrical  Design  News  (EDN)  1976-1978  as 
well  as  from  TRW  product  sheets.  Microprocessor  characteristics  —  including 
word  length,  internal  registers,  indexed  addressing  capabilities,  and  multiply 
instruction  capability  —  are  listed  in  Table  A-I.  The  A/D  and  D/A  character¬ 
istics  —  including  word  length,  conversion  time,  and  technology  —  are  shown 
in  Table  A-II.  Table  A-III  displays  multiplier  characteristics  including  word 
length,  multiply  time,  and  technology. 
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TABLE  A-II 


REPRESENTATIVE  A/D  AND  D/A  CONVERTERS 


Converter 


Type 


A/D 


D/A 


Manufacturer 

Model 

Word  Length 
(bits) 

Conversion 
Time  (nsec) 

Technology 

TRW 

TDC1007J 

8 

35xl0”3 

Bipolar 

TRW 

TDC1001J 

8 

400xl0-3 

Bipolar 

TRW 

TDC1002J 

8 

1 

Bipolar 

Analog  Devices 

AD75705 

8 

40 

CMOS 

Da  tel 

ADC-MC88C 

8 

500 

Bipolar 

Analog  Devices 

AD7570L 

10 

120 

CMOS 

Datel 

ADC-HX12B 

12 

20 

Hybrid 

Analog  Devices 

AD572BD 

12 

25 

— 

Micre  Networks 

ADC80 

12 

25 

Hybrid 

National 

Semiconductor 

ADC1210 

12 

50 

Hybrid 

TRW 

TDC1016J 

8 

35xl0“3 

Bipolar 

Analog  Devices 

AD7523JN 

8 

100xl0"3 

— 

Datel 

DAC-UP88 

8 

2 

Bipolar 

National 

Semiconductor 

DAC0800 

8 

135 

Bipolar 

Datel 

DAC-088 

8 

150 

Bipolar 

TRW 

TDC1017J 

10 

50xl0“3 

Bipolar 

Analog  Devices 

AD7541KN 

12 

1 

— 

Datel 

DAC-HK12B 

12 

3 

Hybrid 

Harris 

Semiconductor 

Hl-5612 

12 

85 

Bipolar 

Harris 

Semiconductor 

Hl-562 

12 

200 

Bipolar 

Datel 

DAC-HA12B 

12 

500 

Hybrid 

Analog  Devices 

AD7531 

12 

500 

Hybrid 

REPRESENTATIVE  MULTIPLIERS 
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APPENDIX  B 


INTEL  8080  SOFTWARE  FOR  LQG  CONTROLLER 


am  macro  Assciiin,  vci  a.o  errors  •  •  page  i 


KALMAN  FILTER/CONTROLLER 

PROJECT i  MICROPROCESSOR  IMPLEMENTATION  OF  MODERN  C 

PROCRMMR <  J.  KRODEL.  DIGITAL  COMPUTER  LAS 

DATE i  17-AUG-79 

VERSION!  00.00 

REVISION!  00.00 

FUNCTIONAL  DESCRIPTION! 

THIS  PROGRAM  CONTROLS  A  2ND 

ORDER  SYSTEM,  USING  MODERN  CONTROL 

METHODS.  THE  SASIC  EQUATIONS  FOLLOW 


U  •  PH  I DIV  ♦  HDSZ 

KT1  K  K 

U  •  W 

K  K+l 

U  •  GDSU 

K*1  K»l 

WHERE! 

Z  •  SYSTEM  MEASUREMENT  VECTOR 

K 

HD  •  KALMAN  FILTER  GAIN  MATRIX 


W  •  PAST  STATE  ESTIMATE  VECTOR 
K 

PNID  •  CLOSED  LOOP  SYSTEM  MATRIX 


W  •  NEXT  STATE  ESTIMATE  VECTOR 

K«1 

CD  •  CLOSED  LOOP  FEEDSACK  GAIN  MATRIX 

U  •  SYSTEM  INPUT  VECTOR 

K*1 


FOR  THE  SECOND  ORDER  SYSTEM! 

Z  •  IXt  VECTOR 

HD  •  2X1  MATRIX 

W  •  2X1  VECTOR 

PHID  •  2X2  MATRIX 

CD  •  1X2  MATRIX 

U  •  1X1  VECTOR 

REVISION  HISTORY! 


SYSTEM  EQUATES! 


Mil 

VSI 

EQU 

1 

I 

0  OF  ELEMENTS  IN  VECTOR 

#002 

MSI 

COO 

2 

1 

•  ROWS  IN  MATRIX 

sooo 

DMA1 

EQU 

SOOOH 

1 

DATA  MATRIX  START  ADDR  11 

5100 

PNNA1 

COU 

SlOOH 

| 

PARTIAL  MATRIX  MPY  START  ADD 

S200 

MMRA1 

SOU 

S20QH 

1 

MATRIX  MPY  RESULT  START  ADDR 

I 

I 


B-l 


761 

9992 

US2 

EQU 

2 

1  8  OF  ELEMENTS  IN  UECTOR 

77 1 

9992 

a  52 

EOU 

2 

t  8  ROUS  tN  MATRIX 

7»l 

5399 

MM2 

EOU 

6399H 

1  DATA  MATRIX  START  A99R  82 

79 « 

5499 

PNMA2 

EOU 

5499M 

|  PARTIAL  MATRIX  APV  START  ADD 

••< 

•  1 1 
82 1 

5699 

MHRA2 

1 

1 

EOU 

6599H 

t  MATRIX  APV  RESULT  START  ADDA 

83l 

9992 

US3 

EOU 

2 

1  8  OF  ELEMENTS  IN  UECTOR 

84 1 

9991 

853 

EOU 

1 

1  8  ROWS  IN  MATRIX 

85 1 

5699 

DIMS 

EOU 

5699H 

t  DATA  MATRIX  START  AD9R  83 

861 

5799 

PHMA3 

EOU 

5799M 

1  PARTIAL  MATRIX  NPY  START  ADD 

871 

5899 

HNRA3 

EOU 

5899M 

t  MATRIX  NPY  RESULT  START  A99R 

88i 

1 

89  > 

J 

9«i 

1 

Wli 

S899 

UOUT 

EOU 

5899H 

1  OUTPUT  UAR  LOCATION 

921 

5399 

STRIPC 

EOU 

5399H 

1  STRIP  CHART  UAR  LOCATION 

93i 

1 

941 

J 

95i 

3C3D 

0R6 

3C3DH 

961 

3C3D 

C38941 

JAP 

IMTR 

>  SET  UP  INTERRUPT  SERU  ROUT. 

971 

1 

98t 

1 

99  ■ 

4999 

0R6 

4999M 

169I 

i 

16H 

i  IMIT1ALZATIOM 

162> 

| 

1631 

4999 

F3 

91 

1  DISABLE  INTERRUPTS 

1641 

4991 

319949 

LXI 

SP.4999H 

,  SET  UP  STACK  POINTER 

I95i 

I 

196i 

| 

1971 

i 

1981 

1  PROGRAM  START  I 

1991 

t 

1191 

,  MULTIPLY 

MATRIX  HO  (KALMAN  FILTER  CAIN  MATRIX  1  UIT* 

lilt 

1 

UCCTOR  Z  (SYSTEM  MEASUREMENT  UECTOR). 

112t 

|  H9 

IS  2 

ROUS  X  1  COL 

1131 

1141 

115i 

i  z 

IS  1 

ROW  X  1  COL 

4994 

8TRTH 

1161 

4994 

3C91 

AUI 

A.US1 

1  ESTABLISH  UECTOR  SIZE 

117i 

4996 

119951 

LXI 

D.PMHA1 

1  PARTIAL  MATRIX  NPY  START  ADD 

1181 

4999 

219959 

LXI 

H.9MA1 

1  DATA  MATRIX  START  A9DR 

1191 

1 

1291 

499C 

COLN1 1 

12U 

499C 

FS 

PUSH 

PSM 

1  START  NEXT  COLUMN  NPY,  SAUE 

1221 

4999 

9692 

AUI 

8.  MSI 

1  ESTABLISH  MATRIX  ROW  SIZE 

1231 

499F 

4E 

NOU 

C.M 

1  SET  OPERAND  81 

1241 

4919 

23 

I  MX 

H 

1  POINT  TO  OPERAND  82 

1251 

t 

126i 

4911 

ROWN1I 

1271 

4911 

C5 

PUSH 

8 

1  MPY  THE  ELEMENTS  IN  EACH  ROU 

1281 

4912 

E5 

PUSH 

M 

1  SAUE  B.C.H  8  L 

1291 

4913 

66 

MU 

H,M 

j  GET  OPERAND  82 

1391 

4914 

C94F41 

CALL 

MULT 

1  8  BIT  SIGNED 

1311 

4917 

?C 

MU 

A.H 

j  PREPARE  TO  STORE 

I32i 

4918 

12 

STAX 

D 

1  SAUE  PARTIAL  MATRIX  NPY 

1331 

4919 

13 

INX 

D 

1  ADJUST  SAUE  POINTER 

1341 

4919 

El 

POP 

M 

1  RESTORE  NIL 

I35i 

4918 

23 

INX 

M 

1  POINT  TO  NEXT  OPERAND 

136i 

491C 

Cl 

POP 

8 

1  RESTORE  UECTOR  COUNT  (8 ) 

1371 

•  RESTORE  OPERAND  81  (C> 

I38i 

4919 

95 

OCR 

8 

1  COLUMN  ALL  DONE  T 

1391 

4915 

C2I149 

JMZ 

ROUM1 

1  M 

1491 

4921 

n 

POP 

PSU 

1  YES,  RESTORE  UECT  SIZE 

1411 

4922 

39 

9CR 

A 

1  ALL  MULTIPLIES  COMPLETE  7 

M2i 

4923 

C29C49 

JMZ 

COLM1 

1  NO 

1431 

1  YES,  SUN  PART I MLS  TO  CONPLET 

1441 

4926 

9692 

NU1 

8. MSI 

1  REESTABLISH  MATRIX  ROU  SIZE 

1451 

4928 

119952 

LXI 

D.MNRA1 

1  MATRIX  MPY  RESULT  START  ADDR 

1461 

4928 

219951 

LXI 

M.PMMA1 

1  PARTIAL  NAT  MPY  START  ADDR 

1471 

M8l 

4925 

SUNAli 

1491 

492E 

9E91 

AUI 

C.US1 

1  REINITIALIZE  UECTOR  SIZE 

1591 

4939 

AF 

XRA 

A 

1  CLEAR  REG  A 

B-2 


THIS  PAGE  IS  BEST  QUALITY  PRACTICABLE 

KH'wM  Lvr  i  t  '10  LV>C 


3\<  ■ 

tiuj.  w 


1S1 1 

4831 

95 

PUSH 

0 

»  OITAIH  POINTER  OFFSET  IH  05E 

152) 

4832 

1688 

MU! 

0.8 

t  CLEAR  UPPER  PORTION  OF  DtE 

153i 

4834 

1C82 

MU! 

E.MS1 

1  SET  OFFSET,  MATRIX  ROU  SIZE 

1541 

1 

155t 

4836 

6UH81 i 

1561 

4836 

86 

AOO 

M 

1  A  •  A  ♦  ML 

1571 

4837 

19 

DAD 

0 

»  HI  •  HL  ♦  OE  (OE  •  OFFSET) 

156 1 

4838 

80 

OCR 

c 

1  ALL  TERMS  SUMMED  7 

159i 

4839 

C23648 

JNZ 

SUMD1 

>  HO 

1661 

483C 

01 

POP 

0 

1  VES.  RESTORE  RESULT  ADDR 

1611 

4830 

12 

STAX 

0 

1  STORE  RESULT 

1621 

483E 

85 

OCR 

1 

1  MATRIX  NPV  COMPLETE  7 

163i 

.♦•■sc 

CA5248 

JZ 

DONE  1 

1  VES 

1641 

4842 

13 

INX 

0 

t  NO.  POINT  TO  NEXT  RESULT  ADD 

165i 

4843 

05 

PUSH 

0 

»  ADJUST  TERN  POINTER  TO  LAST 

1661 

4844 

218851 

LXI 

H.PMMA1 

I  6ET  SASE  ADDR 

1671 

4847 

3E82 

MU! 

A. MSI 

1  6ET  MATRIX  ROU  SIZE 

1681 

4849 

98 

SUI 

I 

1691 

484A 

SF 

MOU 

E.A 

1  CET  OFFSET 

1761 

4848 

1688 

MU! 

0.8 

t  CLEAR  UPPER  PORTION  OF  OE 

1711 

4840 

19 

DAO 

0 

t  HL  •  PMMA  «  US  -  REG  8 

1721 

484C 

01 

POP 

0 

1731 

484F 

C32E49 

JHP 

SURA1 

1741 

I 

1751 

4852 

DOME  1 l 

1761 

1 

1771 

) 

178i 

1 

MULTIPLY  MATRIX  AMID  (CLOSED  LOOM  SVSTEN  MATRIX)  Ul 

179i 

1 

UECTOR  W  (PAST  STATE  WECTOA  ) . 

186i 

1 

OHIO  IS  2 

ROUS  X  2 

COLS 

181 1 

1 

U 

IS  2 

ROUS  X  1 

COL 

182i 

1 

1831 

4852 

3E82 

MU  Z 

A.US2 

1  ESTABLISH  UECTOR  SIZE 

1841 

4854 

118854 

LXI 

0.PMMA2 

1  PARTIAL  MATRIX  NPV  START  ADD 

1851 

4857 

218853 

LXI 

H.0MA2 

1  DATA  MATRIX  START  ADDR 

1861 

1 

187i 

485A 

C0LN21 

1881 

48SA 

FS 

PUSH 

PSU 

1  START  NEXT  COLUMN  NPV,  SAUE 

1891 

48S8 

8682 

MUI 

0.NS2 

1  ESTABLISH  MATRIX  ROU  SIZE 

1961 

485 D 

4E 

MOU 

C.M 

1  GET  OPERAND  81 

191  ■ 

48SE 

23 

INX 

H 

,  POINT  TO  OPERAND  82 

1921 

1 

1931 

485F 

*04*42  ■ 

1941 

485F 

CS 

PUSH 

8 

)  MPV  THE  ELEMENTS  IH  EACH  ROU 

1951 

4868 

ES 

PUSH 

H 

)  SAUE  B.C.H  6  L 

1961 

4861 

66 

MOU 

H.H 

1  GET  OPERAND  82 

1971 

4862 

C04F41 

CALL 

MULT 

l  8  BIT  SIGNED 

1981 

4865 

?C 

MOU 

A.N 

1  PREPARE  TO  STORE 

1991 

4866 

12 

STAX 

0 

1  SAUE  PARTIAL  MATRIX  NPV 

2681 

4867 

13 

INX 

0 

1  ADJUST  SAUE  POINTER 

2811 

4868 

El 

POP 

H 

1  RESTORE  NIL 

282i 

4869 

23 

INX 

M 

j  POINT  TO  NEXT  OPERAND 

283t 

486A 

Cl 

POP 

8 

j  RESTORE  UECTOR  COUNT  (B> 

2841 

t  RESTORE  OPERAND  81  (C) 

285  ■ 

4868 

85 

OCR 

• 

t  COLUMN  ALL  DONE  7 

286i 

466C 

C25F48 

JNZ 

R0UN2 

1  NO 

2871 

486F 

Fl 

POP 

PSU 

1  VES,  RESTORE  UECT  SIZE 

28Si 

4878 

30 

OCR 

A 

,  ALL  MULTIPLIES  COMPLETE  ? 

2891 

4871 

C25A48 

JNZ 

C0LN2 

1  NO 

2181 

,  VES.  SUM  PARTIALS  TO  CONPLET 

21H 

4874 

8682 

MUI 

I.NS2 

t  REESTABLISH  MATRIX  ROU  SIZE 

212i 

4876 

118855 

LXI 

D.MMRA2 

1  MATRIX  NPV  RESULT  START  ADD* 

213i 

4879 

218854 

LXI 

H.PNHA2 

1  PARTIAL  MAT  MPV  START  ADD* 

2141 

1 

2151 

487C 

SUNA21 

216i 

487C 

8E82 

MUI 

C.US2 

1  REINITIALIZE  UECTOR  SIZE 

2171 

487E 

AF 

XRA 

A 

1  CLEAR  REG  A 

2191 

487F 

05 

PUSH 

0 

,  OBTAIN  POINTER  OFFSET  IN  D6E 

2191 

4888 

1888 

MUI 

0.8 

,  CLEAR  UPPER  PORTION  OF  D6E 

2281 

4822 

1E82 

MUI 

E.HS2 

1  SET  OFFSET,  MATRIX  ROU  SIZE 

2211 

1 

222i 

4814 

51*402 1 

223t 

4884 

86 

AOO 

N 

1  A  •  A  ♦  HL 

224i 

4885 

19 

DAD 

0 

1  HL  •  ML  •  OE  (OE  •  OFFSET) 

225i 

4886 

80 

OCR 

c 

1  ALL  TERMS  BUMMED  7 

B-3 


22s> 

4887 

C28448 

JMZ 

SU6B2 

1 

60 

227) 

4898 

01 

606 

0 

1 

YES.  RCST0R6  RESULT  ADDR 

az»i 

4888 

12 

STAX 

0 

> 

STORE  RESULT 

229) 

488C 

85 

OCR 

0 

9 

6ATRIX  66V  C066LETE  7 

23#  > 

4880 

C88848 

J2 

00662 

1 

V6S 

23H 

4898 

13 

1NX 

0 

1 

60.  60I6T  TO  NEXT  RESULT  *00 

232> 

4891 

05 

6U5H 

0 

9 

AD4UST  TERR  60 INTER  TO  LAST 

233) 

4892 

218854 

LX  I 

H. 666*2 

t 

SET  BASE  *006 

234) 

4895 

3682 

mn 

*,652 

1 

OCT  6*7* IX  ROO  SIZE 

235) 

4897 

98 

SU» 

8 

236) 

4898 

5F 

600 

6.6 

9 

CCT  OFFSET 

237) 

4899 

1688 

601 

0,9 

9 

CLEAR  U66ER  60RT106  OF  06 

238) 

4898 

19 

080 

0 

9 

6L  •  666*  ♦  US  -  REC  8 

239) 

499C 

01 

606 

0 

248) 

4890 

C37C48 

J66 

5U6A2 

241) 

| 

242) 

1 

243) 

•  DO  U6CT0R 

ADDS  TO  C066UT6  0(6*11  1.6. 

244) 

X 

245) 

1  0(6*111  • 

661080(611 

i  6982(6)1 

246) 

| 

247) 

| 

* 

248) 

1 

* 

* 

249) 

i  0(6*1 >H  « 

661080(616 

*  6082(616 

258> 

251< 

| 

252> 

4888 

VOHtZi 

253) 

4888 

218856 

LX1 

6.06*3 

I 

CET  0(6*1 1  STORAGE  ARE*  ADOR 

254) 

4883 

65 

PUSH 

H 

I 

TE66  SAVE 

255) 

4884 

218852 

LX1 

H.66RA1 

1 

OBTAIN  N0CZ  RESULT  START  A 

256) 

4887 

118855 

LX1 

0,666*2 

I 

OBTAIN  661080  RESULT  START  A 

257) 

4888 

8682 

601 

0.WS3 

1 

OBTAIN  8  OF  TERNS  TO  ADD 

258) 

48AC 

8681 

601 

C.6S3 

| 

OBTAIN  OFFSET  TO  STORE  SUNS 

259) 

4886 

8C 

168 

C 

268) 

1 

26D 

48AF 

ADDMXT 

) 

262 ) 

488F 

AF 

XRA 

* 

) 

CLEAR  A  REC 

263) 

4888 

86 

600 

6 

1 

OET  8082  TERN 

264) 

4881 

68 

XCHC 

265) 

4882 

86 

600 

6 

9 

ADO  6610*0  TERN 

266> 

4883 

37 

5TC 

9 

SET  CARRY  •  9 

267) 

4884 

3F 

CNC 

268) 

4885 

17 

*AL 

9 

ADJUST  FOR  2.9  SCALING 

269) 

4886 

DAC449 

JC 

66C 

9 

NEC  OR  60S  7 

278) 

4889 

87 

OR* 

* 

1 

SET  CONDITION  CODE 

271) 

4888 

628646 

46 

HOFLO 

1 

60SITIUE.  ANY  OUERFLOO  7 

272) 

4880 

6676 

0R1 

766 

9 

YES,  FORCE  TO  LARGEST  * 

273) 

9 

274) 

488F 

ttoriot 

275) 

488F 

6676 

*61 

7FH 

1 

FORCE  TO  POSITIVE  * 

276) 

48C1 

C3C648 

466 

SCAL1 

277) 

i 

278) 

49C4 

NCC« 

279) 

48C4 

6688 

ORI 

886 

9 

FORCE  TO  HECATIUE  * 

288) 

j 

281) 

48C6 

•CftLtl 

282) 

48C6 

63 

XTHL 

| 

GET  STORAGE  ADDRESS 

283) 

48C7 

77 

600 

6.* 

9 

STORE  SUN 

284) 

48C8 

85 

OCR 

8 

| 

CHEC6  IF  ALL  TERRS  ADDED 

285) 

48C9 

CAM49 

4Z 

00664 

286) 

48CC 

70 

600 

A.L 

9 

ADJUST  STORAGE  ADDRESS 

287) 

49CD 

81 

*00 

C 

288) 

49CE 

66 

600 

L,A 

289) 

48CF 

63 

XTHL 

| 

RESTORE  60 INTERS 

298) 

4808 

69 

XCHC 

29D 

4801 

23 

16X 

H 

I 

601NT  TO  NEXT  6DSZ  TERN 

292) 

4802 

13 

I6X 

0 

I 

POINT  TO  «XT  P61D80  TERN 

293) 

4803 

C3AF49 

466 

AODHXT 

9 

ADD  NEXT  TERNS 

294) 

9 

295) 

I 

296) 

1  UPDATE  0(6)  WITH  NEOLV 

CALCULATED  0(6*1) 

29 7) 

1 

298) 

299) 

4806 

io«64i 

388) 

4806 

61 

606 

H 

9 

RESTORE  STAC6 
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4007 

2C02 

MWI 

L.WS3 

1  SET  8  OF  TERMS  TO  STORE 

3*2 1 

4000 

CS 

PUSH 

H 

«  TEMP  SAWE 

3*3 1 

4000 

210056 

LX  I 

H,  DM03 

1  SET  WIK«>>  STORE ACE  AREA  AOO 

3*4 1 

4000 

0C01 

MWI 

C.MS3 

1  SET  OFFSET  OF  W(K«I > 

MSt 

40  Of 

0C 

IMA 

C 

3Mi 

40C0 

118063 

LXI 

0.0MA2 

I  GET  W(K)  STORAGE  AREA  ADDR 

347 1 

40C3 

0682 

MWI 

B.MS2 

1  GET  OFFSET  OF  N(K> 

Mil 

40CS 

64 

I  NR 

8 

3Mi 

1 

31*i 

40C6 

STthXTi 

3111 

40C6 

7E 

HOW 

A.N 

1  GET  W(K«1  ) 

312i 

40C7 

12 

STAX 

0 

1  STORE  INTO  OLO  W(K > 

313i 

40C8 

E3 

XTML 

1  GET  8  OF  TERMS  REMAINING  TO 

3141 

40C9 

20 

OCR 

L 

1  ANV  LEFT  ? 

31St 

4  OCA 

C0F740 

JZ 

DOMES 

1  NO 

31Ct 

40CO 

E3 

XTML 

1  VES.  RESTORE  POINTER 

317i 

40CE 

70 

HOW 

A.  L 

1  ADJUST  FOR  NEXT  W(K*1> 

31«i 

40EF 

81 

ADO 

C 

310i 

40F0 

6F 

MOW 

L.A 

3201 

40F1 

70 

MOW 

A.E 

1  ADJUST  FOR  NEXT  W(K> 

3211 

46F2 

80 

A00 

8 

322i 

40F3 

SF 

MOW 

C.A 

323i 

40F  4 

C3C640 

JMP 

STRHXT 

3241 

J 

32Si 

1 

326i 

1  NULTIPLV  MATRIX  60  (CLOSED  LOOP  FEEOO0CK  MATRIX)  WI 

3271 

1 

WECTOR  W  (NEXT  STATE  WCCTOR). 

3201 

1  CD 

IS  1  ROW  X  2  COLS 

3201 

1  u 

IS  2  ROWS  X  1  COL 

3301 

1 

3311 

40F7 

DOMES i 

332i 

40F7 

El 

POP 

H 

l  RESTORE  STACK 

3331 

40F0 

3C02 

MWI 

A.US3 

1  ESTABLISH  WECTOR  SIZE 

334i 

40FA 

1 10057 

LXI 

D.PNNA3 

1  PARTIAL  MATRIX  MPV  START  ADD 

335i 

40FO 

218066 

LXI 

N.0MA3 

1  DATA  MATRIX  START  ADDR 

3361 

1 

3371 

4100 

COLM3 i 

338 1 

4100 

FS 

PUSH 

PSW 

t  START  NEXT  COLUMN  MPV.  SAWE 

3301 

4101 

0601 

MWI 

S.MS3 

1  ESTABLISH  matrix  ROW  SIZE 

346i 

4103 

4E 

MOW 

C.N 

I  GET  OPERAND  81 

3411 

4104 

23 

I  MX 

M 

1  POINT  TO  OPERAND  82 

342i 

1 

3431 

410S 

ROWN3I 

3441 

4105 

CS 

PUSH 

8 

1  MPV  THE  ELEMENTS  IN  EACH  ROW 

3451 

4106 

E5 

PUSH 

M 

1  SAWE  8.C.H  8  L 

3461 

4107 

66 

MOW 

M.N 

1  GET  OPERAND  82 

3471 

4108 

CD4F41 

CALL 

MULT 

1  8  BIT  SIGNED 

3481 

4101 

7C 

MOW 

A.H 

»  PREPARE  TO  STORE 

3401 

410C 

12 

STAX 

0 

1  SAWE  PARTIAL  MATRIX  MPV 

3501 

4100 

13 

INX 

0 

»  ADJUST  SAWE  POINTER 

3511 

4I0C 

El 

POP 

H 

1  RESTORE  H  8  L 

3S2i 

410F 

23 

INX 

H 

>  POINT  TO  NEXT  OPERAND 

3S3> 

4110 

Cl 

POP 

8 

1  RESTORE  WECTOR  COUNT  (8) 

3541 

1  RESTORE  OPERAND  81  (C> 

355i 

4111 

65 

OCR 

8 

I  COLUMN  ALL  DONE  7 

356i 

4112 

C20S41 

JNZ 

R0WH3 

1  NO 

357i 

4115 

FI 

POP 

PSW 

I  VES,  RESTORE  WECT  SIZE 

358i 

4116 

30 

OCR 

A 

1  ALL  MULTIPLIES  COMPLETE  7 

3501 

4117 

C26041 

JM2 

C0LN3 

1  NO 

3601 

1  VES,  SUM  PARTIALS  TO  CONPLET 

361i 

4118 

0601 

MWI 

8,  MSS 

1  REESTABLISH  MATRIX  ROW  SIZE 

362 1 

41 1C 

110058 

LXI 

D.MNRA3 

1  MATRIX  MPV  RESULT  START  ADDR 

3631 

4UF 

210067 

LXI 

N.PMNA3 

1  PARTIAL  NAT  MPV  START  ADDR 

3641 

1 

36Si 

4122 

SUHA3 l 

366i 

4122 

0602 

MWI 

C.WS3 

1  REINITIALIZE  WECTOR  SIZE 

3671 

4124 

AF 

XRA 

A 

1  CLEAR  REG  A 

3681 

4125 

05 

PUSH 

0 

j  OBTAIN  POINTER  OFFSET  IN  PIE 

360< 

4126 

1600 

MWI 

0.0 

1  CLEAR  UPPER  PORTION  OF  DIE 

3701 

4128 

IC01 

MWI 

E.MS3 

1  SET  OFFSET.  MATRIX  ROW  SIZE 

37H 

1 

3?2i 

4120 

SUNBJi 

373i 

4120 

86 

ADO 

M 

1  A  *  A  »  ML 

3741 

4120 

19 

DAD 

0 

,  ML  •  ML  ♦  DE  (DE  •  OFFSET) 

3751 

4  llC 

60 

OCR 

C 

1  ALL  TERNS  SUNNED  7 
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376) 

41 2D 

C22941 

JNZ 

SUN*  3 

s 

NO 

377) 

4139 

81 

POP 

D 

1 

VES.  RESTORE  RESULT  NDDR 

376) 

4131 

12 

5T9X 

0 

1 

STORE  RESULT 

379) 

4132 

95 

OCR 

B 

1 

HNTRIX  NPV  CONPLETE  7 

3*6) 

4133 

C94641 

JZ 

DOMES 

1 

VES 

3*1  s 

4136 

13 

INX 

D 

1 

NO.  POINT  TO  NEXT  RESULT  NDD 

3*2) 

4137 

DS 

PUSM 

D 

1 

NDJUST  TERR  POINTER  TO  LNST 

3*3) 

4138 

219957 

LXI 

H.PNNN3 

l 

GET  BNSE  NDDR 

3*4) 

413* 

3C91 

NUI 

N.NS3 

1 

GET  NNTRIX  SIZE 

3*5  > 

4130 

99 

SU* 

1 

3*6> 

413C 

5F 

NOW 

E.N 

1 

GET  OFFSET 

387) 

41 3F 

1699 

NUI 

0.9 

1 

CLENR  UPPER  PORTION  OF  DC 

38*) 

4141 

19 

D9D 

D 

} 

HL  •  PHNN  ♦  US  -  REG  8 

389) 

4142 

D1 

POP 

D 

39*> 

4143 

C 32241 

JNP 

SUNNS 

39l> 

| 

392) 

4146 

DOMC3I 

393) 

4146 

37 

STC 

l 

SET  CNRRV  •  9 

394) 

4147 

3F 

CNC 

l 

CHECK  FOR  INTERRUPT  CONPLCTI 

395) 

4148 

FI 

El 

1 

NEEDED  FOR  1ST  PNSS  ONLY 

396) 

i 

397) 

4149 

UAITLP) 

398) 

4149 

824941 

JNC 

UN I TLP 

1 

UNIT  FOR  INTERRUPT 

399) 

414C 

C39449 

JNP 

5TRT1 

1 

INTERRUPT  SERVICED 

499) 

1 

CALCULATE  NEXT  OUTPUT 

491  ) 

J 

492) 

i  SUBROUTINE 

'NULT '  - 

— 

8  BIT  SIGNED  MULTIPLY 

493> 

| 

494) 

| 

ML  • 

M8C 

495) 

a 

496) 

1  INPUTS)  C 

-  MULTIPLICAND  8  BIT  SIGNED 

497) 

498  ■ 

1 

M 

-  MULTIPLIER  8  BIT  SIGNED 

499) 

l  OUTPUTS)  MIL  -  PRODUCT 

16  BIT  SIGNED 

419) 

1 

411  ) 

1  DESTROYS ) 

8.B.C.M.L 

412) 

1 

413) 

414F 

HULTl 

414) 

414F 

7C 

NOV 

N.M 

1 

CHECK  SIGN  OF  MULTIPLIER  (Ml 

415) 

4159 

87 

ORN 

N 

416) 

4151 

F26E41 

JP 

NULMP 

J 

M  IS  POSITIUE 

417) 

4154 

2F 

CNN 

1 

MULTIPLIER  (H)  IS  NEGATIVE 

418) 

4ISS 

3C 

I  NR 

N 

1 

TAKE  2'S  COMPLIMENT 

419) 

4156 

67 

NOU 

M.N 

1 

429) 

4157 

79 

NOW 

N.C 

1 

CHECK  SIGN  OF  MULTIPLICAND 

421) 

4158 

*7 

ORN 

N 

422) 

4159 

F 26341 

JP 

NULOS 

1 

INPUTS  NAVE  OPPOSITE  SIGNS 

423) 

4  ISC 

2F 

CNN 

1  MULTIPLICAND  (C>  IS 

424) 

41SD 

3C 

I  MR 

N 

1 

TAKE  2'S  COMPLIMENT 

425) 

4154 

4F 

NOU 

C.N 

t 

426) 

1 

427) 

415F 

NULSS  > 

428: 

415F 

CD7941 

CNLL 

INUL 

1 

SAME  SIGH,  MULTIPLY  AND  RETU 

429) 

4162 

C9 

RET 

439) 

| 

431) 

4163 

NULOSt 

432) 

4163 

CD7941 

CNLL 

IMUL 

1 

NSC  HAVE  OPPOSITE  SIGNS 

433) 

4166 

28 

OCX 

M 

1 

TAKE  2'S  COMPLIMENT  OF  PRODU 

434) 

4167 

7D 

NOU 

N.L 

435) 

4168 

2F 

CNN 

436) 

4169 

6F 

NOU 

L.N 

1 

2'S  COMP  OF  L 

437) 

4169 

7C 

NOU 

N.M 

438) 

416* 

IF 

CRN 

439> 

416C 

67 

NOU 

M.N 

1 

2'S  COMP  OF  M 

449) 

416D 

C9 

RET 

1 

RETURN  MITH  FINAL  RESULT  IN 

441 ) 

1 

442) 

416E 

NULMPl 

443) 

416E 

79 

NOU 

N.C 

f 

M  (MULTIPLIER)  IS  POSITIVE 

444) 

416F 

17 

ORN 

N 

1 

CHECK  SIGN  OF  MULTIPLICAND 

445) 

4179 

F25F41 

JP 

NULSS 

446) 

4173 

IF 

CNN 

1 

MULTIPLICAND  (C>  IS  NEGATIVE 

447) 

4174 

3C 

1NR 

N 

1 

TAKE  2'S  COMPLIMENT 

448> 

4175 

4F 

NOU 

C.N 

449> 

4176 

C 36341 

JNP 

NULOS 

1 

DO  OPPOSITE  SION  MULTIPLY 

459) 

1 
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4SH 

| 

452) 

| 

SU9R0UTINE  'IWH '  -  8  8XT  UNSIGNED  FRACTIONAL 

453) 

| 

4S4t 

| 

INPUTS >  C  “  NULTIPIIC9N9  8  BIT  UNSI6NE9 

455i 

| 

N  -  MULTIPLIER  8  BIT  UNSIGNED 

450 

# 

45?) 

# 

OUTPUTS)  HL  -  PRODUCT  IS  BIT  HNS I ONE 9 

45«> 

| 

4S9> 

1 

DESTROYS)  A.B.H.L 

459  > 

t 

451> 

4179 

imiu 

452) 

4179 

9599 

NUI  8,9  1  CLC9R  FOR  FOLLOWING  '999'  IN 

453) 

4178 

58 

NOU  L,8  1  CLE9R  BOTTOM  H9LF  OF  HL 

4541 

417C 

X98 

mil  9,8  1  1NITI9LIZE  LOOP  COUNTER 

455  < 

1 

456) 

417E 

inuti  i 

45?) 

417E 

29 

999  H  t  SHIFT  RESULT 

450 

417F 

928341 

JNC  IHUL2  |  IF  MSB  SET.  990  NULTIPL1C9N0 

459) 

4182 

99 

099  B  j  HL  •  NL  ♦  BC 

475) 

4711 

4183 

iniL2i 

472) 

4183 

30 

OCR  9  t  DECREMENT  «  TEST  LOOP  COUNTE 

473) 

4184 

C27E41 

jhz  muii 

474) 

4187 

29 

099  H  1  9DJUST  FOR  FR9CTI0N9L  NPV 

47S« 

4188 

C9 

RET 

476) 

| 

4771 

f 

4751 

| 

INTERRUPT  SERVICE  ROUTINE 

479) 

| 

459) 

4511 

482) 

1 

FUNCTI0N9L  DESCRIPTION) 

J 

| 

THIS  ROUTINE  IS  ENTERED  WHEN  THE  CLOCK  I9ELT9  T) 

483> 

| 

GOES  OFF.  DELT9  T  IS  9  SQU9RE  W9UE  CLOCK  INPUT 

484) 

| 

FROM  9  FUNCTION  6ENER9T0R.  HENCE  XT  IS  PRESETT9BL 

485) 

1 

IT  PROVIDES ■ 

486< 

J 

487* 

| 

9)  9  9ELT9  T  TINE  STEP 

488  < 

1 

B)  9  NE9NS  OF  IN9IC9TIN6  END  OF  CONVERSION  FOR 

489) 

| 

499> 

J 

920  H9X  CONVERSION  TINE  IS  .05  NS.  HENCE  BELT9  T 

49D 

1 

BE  SET  HIGHER 

492  > 

1 

493) 

I 

THE  ROUTINE  RE90S  IN  9  12  BIT  929  INPUT  Z(K>. WHICH 

.494) 

f 

TRUNCATES  THE  LE9ST  SICNIFIC9NT  4  BITS  SINCE  ONLY 8 

495) 

1 

BITS  MRC  NEEDED. 

496) 

J 

49?) 

| 

THE  ROUTINE  9LS0  OUTPUTS  U(K>  TO  THE  9N9L0G  SYSTEM 

498) 

| 

HERNS  OF  9  029.  THE  929  IS  8  BIT  MEMORY  MRP  10. 

499) 

| 

2  OUTPUTS  ORE  PROVIDER)  1  TO  THE  SYSTEM 

599> 

| 

i  to  9  strip  chart  recore 

591) 

; 

IN  ROD IT ION,  9  CHECK  IS  DONE  TO  SEE  IF  THE 

592) 

l 

593) 

1 

INTERRUPT  OCCURRED  DURING  CONTROL  CODE 

594) 

I 

CALCULATIONS,  WHICH  COULD  RESULT  IN 

595) 

f 

INACCURATE  CONTROL  COMMANDS.  IF  THIS 

S95) 

I 

ERROR  OCCURS,  THEN  PGM  CONTROL  IS 

597) 

I 

PASSED  TO  THE  MONITOR. 

598) 

s 

S99> 

4189 

INTO 

519) 

4189 

F3 

91  1  DISABLE  INTERRUPTS 

511) 

4189 

FS 

PUSH  PSW  )  SAVE  9 

512) 

4188 

E5 

PUSH  H  |  SAVE  HL 

513) 

| 

514) 

| 

CHECK  IF  CONTROL  CODE  COMPLETED 

515) 

| 

516) 

418C 

33 

INK  SP  )  CHECK  IF  CONTROL  CODE  COMPLE 

517) 

4189 

33 

INK  SP  1  FIND  RET  AD9R  FROM  INTERRUPT 

SIS) 

418E 

33 

INK  SP 

519) 

41BF 

33 

INK  SP 

S29> 

4199 

214941 

LXI  H.W9XTLP  i  GET  WAIT  LOOP  Hi  9D9R 

52U 

4193 

?C 

MOV  9.H 

522) 

4194 

E3 

XTHl  1  GET  INTERR  RET  HI  A99R 

523> 

4195 

94 

SUB  H  1  ARE  THEY  EQUAL  T 

524) 

4195 

C89241 

JNZ  ERRI  1  NO.  INDICATE  ERR.  STOP  PGM 

525> 

4199 

79 

NOV  9.1  1  GET  INTERR  RET  LO  A9DR 
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526  > 

4199 

E3 

XTHL 

1  OET  W9IT  LOOP  LO  9089 

5271 

4199 

95 

BUB 

L 

1  ORE  THEY  E0U9L  7 

528 1 

419C 

C2D241 

JN2 

ERR1 

1  NO.  INDIC9TE  ERR.  STOP  PON 

5291 

419F 

38 

OCX 

SP 

j  YES,  CONTROL  CODE  U9S  COHPLE 

S39i 

4199 

38 

OCX 

SP 

1  RESTORE  STOCK  PNTR  TO  N0RN9L 

5311 

4191 

38 

OCX 

SP 

S32i 

4192 

38 

OCX 

SP 

533i 

9 

5341 

| 

READ  9/0 

53S> 

| 

536: 

4193 

3E82 

hvi 

9,S2H 

1  SET  9/0  RE9D  CH9NNEL 

537: 

4195 

D3C7 

OUT 

SETH 

,  9NPLIFIER  INPUT 

539 1 

4197 

DBES 

IN 

RE5H 

1  RE 90  LOW  BYTE 

539: 

4199 

9f 

RRC 

j  90 JUST  FOR  4  BIT  THR0W9U9Y 

549: 

4199 

9F 

RIIC 

541 : 

4198 

9F 

RRC 

542: 

419C 

9f 

RRC 

543: 

4190 

ESOf 

ani 

9FH 

i  PRESERVE  LOW  NIBBLE 

544: 

410F 

6F 

NOU 

L*9 

1  TENP  S9UE 

545: 

4189 

88C4 

IN 

9E4H 

1  RE9D  HIGH  BYTE 

546: 

4182 

9f 

RRC 

1  90JUST  FOR  HIGH  NIBBLE 

547: 

4183 

9F 

RRC 

549: 

4184 

If 

RRC 

549: 

4185 

Of 

RRC 

559: 

4186 

E6f  9 

9NI 

9F9H 

1  PRESERVE  HIGH  NIBBLE 

551: 

4188 

85 

0R9 

L 

\  HEDGE  TO  FORN  8  BIT  INPUT 

552: 

4189 

819959 

LX  I 

H.DN91 

1  STORE  INPUT  IN  H9TRIX  DATA  A 

553: 

419C 

77 

NOU 

N.A 

5541 

| 

555: 

9 

556: 

1 

OUTPUT  0/9 

(U) 

557: 

1 

NCNORV  H9PPED  1/0 

558: 

1 

559: 

1 

569: 

4180 

219958 

IX I 

H.UOUT 

1  OUTPUT  U 

561  : 

41C9 

7E 

NOU 

9.9 

562: 

41C1 

2199F7 

LXI 

H.9F799H 

563: 

41C4 

77 

NOU 

N.9 

5641 

41CS 

219953 

LXI 

H.STRlPC 

1  OUTPUT  NEHORY  IOC  TO  STRIP  C 

5651 

41C8 

7E 

NOU 

9.N 

566: 

41C9 

2191F7 

LXI 

H.9F791H 

567: 

41CC 

77 

NOU 

N.9 

569: 

41C0 

El 

PON 

H 

5691 

41CE 

FI 

PON 

PSW 

579: 

4tcr 

37 

8TC 

1  INDICATE  INTERRUPT  COHPLE TE 

57H 

4109 

FB 

El 

572 1 

4101 

C9 

RET 

,  ENABLE  INTERRUPTS  5  RETURN 

573: 

1 

5741 

> 

CONTROL  COBC  NOT  CONPLETEB.  ERROR 

57S: 

5761 

4102 

Imh 

577: 

579: 

579: 

4102 

CF 

J 

s 

R5T 

1 

1  BRANCH  TO  NON I TOR  INNEDI9TLY 

Sill 

Stf  i 

1 

09 T9  N9TRIX  ST0R9OE 

AREA 

592: 

f 

> 

THE  FOLLOWING  09T9  IS  FOR  THE  2ND  ORDER  SVSTEN 

593: 

1 

9LL  8'S  ORE  REPRESENTED  9S  FR OCT IONS  WHERE i 

594: 

1 

48  •  FR9C. 1128*9.5 

595: 

5961 

597: 

< 

1 

-8  •  8'S 

COHP  OF  ( 

-FR9C.8I8B49.S1 

599: 

1 

8 

s 

599: 

599: 

5911 

1 

8  NOTE  I  09 1  NS 

BELOW  ARE  FOR  T  •  9.1  SEC  t 

1 

1 

5921 

J 

5931 

f 

Z  -  INPUT 

UECTOR  FROH  980 

5941 

I 

NO  -  H9TRIX 

S95i 

9 

5961 

f 

NO  •  .113 

•  .857 

WHEN  SCALE 0  ON  t.B 

597i 

9 

-.935 

■  -.918 

5991 

9 

599i 

5999 

ORO 

599i 

i 

*  ‘  _  (  1  \  •  J 

B-8 

ft.  ••  ••• 

Mti 

1  NOTE!  MD( 1 >  *  AD(2 )  HAVE  BEEN  COHPLIHEHTED 

*•21 

1 

DUE 

TO  INUCRTEO  INRUT. 

H3i 

1 

*•4  1 

(•M 

M 

BB 

•A 

1  Z<K )  VECTOR  A/0  INPUT  81 

*«5i 

5  Ml 

•8 

BB 

•F9M 

1  NO  HATRIX  R0W1  C0L1 

*•*> 

MM 

1* 

BB 

•  IN 

I  HO  MATRIX  ROW2  C0L1 

*•71 

t 

*•81 

1 

*••■ 

t  U(  K  > 

-  PAST  STATE  VECTOR 

*!•■ 

t  PM  IP 

-  CLOSED  LOOP  SVSTER  MATRIX 

sin 

1 

*12) 

t  PMIP 

•  . 

17264  .*7127  •  .43*32  .•3663 

*13> 

1 

-.2*624  .  *32*5  •  -.132*2  .31M3 

*141 

1 

ONER  SCALED  ON  2.* 

S15i 

1 

Clfil 

53M 

ORG 

S3MN 

*17i 

53M 

4* 

BB 

4*H 

1  U(K  >  PAST  STATE  81  INIT 

*!•■ 

SMI 

M 

BB 

38H 

;  PH ID  MATRIX  R0W1  C0L1 

C19i 

5  M2 

r« 

BB 

PM 

I  PAID  HATRIX  R0W2  C0L1 

*2*  > 

SMS 

48 

BB 

4*N 

<  M(K)  PAST  STATE  82  INIT 

S2H 

SM4 

•S 

OB 

SM 

1  PAID  HATRIX  R0W1  C0L2 

*22  > 

S3** 

29 

BB 

CBN 

J  PAID  HATRIX  R0M2  C0L2 

*23 1 

1 

624t 

i 

*25  > 

I  U(K«1I  -  PRESENT  STATE  UCCTOR 

62C> 

1  GP 

-  CONTROL  GAIN  RATRXX 

6271 

1 

6281 

1  GP  • 

-1.742  -.41412 

•  -.871  - . 24746 

629  > 

1 

WHEN  SCALED  ON  2.* 

•  Jf  * 

63H 

S*M 

1 

ORG 

X 

l 

<S 

1* 

*321 

S*M 

M 

OB 

•A 

t  M(KM  )  PRESENT  STATE  81 

6331 

SMI 

92 

OB 

•BN 

j  GO  HATRIX  R0U1  C0L1 

634i 

5M2 

M 

BB 

•N 

I  U(K«I>  PRESENT  STATE  82 

*35i 

SM3 

E« 

BB 

BC*M 

1  GO  HATRIX  R0W1  C0L2 

636  > 

1 

6371 

f 

6381 

ENO 

639) 

NO  PROGRAH  ERRORS 

*4*  t 

6411 

642) 

mi 

O 

I 

TABLE 

643) 

*44) 

8  •! 

645) 

646) 

• 

*M7 

AODHX 

MAT 

B 

MM  C  M*1 

647) 

COLNl 

4MC 

C0LH2 

4*SA 

C0LN3 

41M  B  *M2 

*48) 

DRA1 

SM* 

0RA2 

S3M 

ORA  3 

S*M  DOME  1  4*52 

649) 

DONE  2 

4«A« 

DONE  3 

414* 

D0NE4 

4*0*  BONES  4«F7 

CS«i 

C 

«M3 

ERR1 

4102 

N 

M*4  IRUL  4179 

6S1> 

I  NOLI 

417E 

IHUL2 

4123 

INTR 

41S9  L  M»5 

*52) 

N 

•M6 

RRRA1 

52M 

NRRA2 

SSM  NRRA3  SBM 

*53> 

RSI 

•M2 

RS2 

•M2 

RS3 

•Ml  NULHP  416E 

*541 

RUIOS 

41*3 

RULSS 

41SF 

NULT 

414F  REG  44C  4 

*55) 

NOfLO 

4«BF 

PRRAI 

SIM 

PRRA2 

S4M  PNRA3  S7M 

650 

•SO 

•M* 

•OMNI 

4*11 

R0WN2 

4*SF  R0UH3  41*5 

*57) 

SCALt 

4M6 

SR 

MM 

STRIP 

SSM  STRNX  4*E6 

*58) 

STRT1 

4M4 

SUNA1 

4*2E 

SURA2 

4«7C  SURAS  4122 

*59) 

SUR81 

4*M 

SORB* 

4«B4 

SORBS 

412A  UOUT  SBM 

CM) 

WS1 

•Ml 

WII 

•M2 

VS  3 

•M2  MAITL  4149 

C*H 

r~ 

u»x  X  XL^.x 


QUALIT*  PHACIXG4aL£ 

Tu  I>i>C 


B-9 


w 


APPENDIX  C 

LSI-11  SOFTWARE  FOR  LQG  CONTROLLER 


KALMAN  FILTEP/CONTROLLFR 

project:  microprocessor  implementation  of  modern  control 

progrmmr:  j.  krodel.  digital  computer  lab 

date:  15-APR-80 

version:  oo.oo 

revision:  oo.oo 

FUNCTIONAL  DESCRIPTION: 

THIS  PROGRAM  CONTROLS  A  5TH 

ORDER  SYSTEM:  ‘JSInG  MODERN  CONTROL 

METHODS.  THE  BASIC  EQUATIONS  FOLLOW 


U  =  PHID*W  +  HD *2 

,K+1  K  K 

U  =  U 

K  K+l 

U  =  GD*W 

K+l  K+l 

where: 

Z  =  SYSTEM  MEASUREMENT  VECTOR 

K 

HD  =  KALMAN  FILTER  GAIN  MATRIX 


U  =  PAST  STATE  ESTIMATE  VECTOR 
K 

PH I D  =  CLOSED  LOOP  SYSTEM  MATRIX 


U  =  NEXT  STATE  ESTIMATE  VECTOR 

K+l 

GD  =  CLOSED  LOOP  FEEDBACK  GAIN  MATRIX 

U  =  SYSTEM  INPUT  VECTOR 

K+l 


FOR  THE  FIFTH  ORDER  SYSTEM 5 

Z  =  5X1  VECTOR 

HD  =  5X5  MATRIX 

U  =  5X1  UEC'iOR 

PHID  =  5X5  MATRIX 

GD  =  4X5  MATRIX 

U  =  4X1  VECTOR 

REVISION  HISTORY: 

ANALOG  INTERFACE*. 

THIS  INTERFACE  ALLOWS  THE  USER  TO  INVESTIGATE  BOTH  THE 
ANALOG  AND  DIGITAL  COMPLTEK  STATES  AT  ANY  POINT  IN 
TIME  OF  THE  SIMULATION/CONTROLLER.  THIS 
PROGRAM  ACTS  AS  A  SLAVE  TO  THE  ANALOG  MACHINE  WITH 


THIS  TOTT  v.  .  ,  _ C-l 

DO*  X  i  Lw  _-.>U 


RESPECT  TO  'MODE*  OPERATION.  THE  3  MODES  ON  THE 
ANALOG  COMPUTER  ARE*. 

I.C.  (INITIAL  CONDITIONS) 

OP  (OPERATE) 

HLD  (HOLD) 

THE  OVERLOAD  CONDITION  WILL  ALSO  BE  HANDLED. 

WHEN  IN  I.C.  MODE  THE  PROGRAM  DECIPHERS  THIS  MODE* 

AND  RESETS  THE  INTERNAL  CLOCK  AND  AWAITS  FOR  THE 
OPERATE  HODE.  ONCE  IN  OPERATE  HODE ,  THE  PROOF. An 
ALLOWS  THE  CLOCK  TO  RUN  FREE  AND  CONTROL  OF  SIMULATION 
BEGINS. 

IF  THE  HOLD  MODE  IS  ENTERED.  THE  CLOCK  IS  IMMEDIATELY 
HALTED.  AND  THE  PROGRAM  CAN  BE  SET  TO  BREAKPOINT  UNDER 
ODT  TO  EXAMINE  THE  PRESENT  STATUS  OF  THE  LSI-11 
CONTROLLER.  LIKEWISE.  ANY  INFORMATION  OF  THE 
SIMULATOR  CAN  BE  OBTAINED  VIA  THE  ANALOG  COMPUTERS 
DIGITAL  KEY  PAD.  WHEN  THE  OPERATE  MODE  IS  LATER 
ENTERED  THE  CLOCK  STARTS  AGAIN  AT  PRECISELY  THE 
POINT  IT  WAS  STOPPED. 

THE  ANALOG  COMPUTER  HAS  THE  CAPABILITY  OF  GOING 
INTO  THE  HOLD  STATE  WHEN  ANY  AMPLIFIER  IS  OVERLOADED. 

IF  THE  SYSTEM  BECOMES  OVERLOADED  THEN  AGAIN 
THE  INTERNAL  CLOCK  IS  HALTED.  AND  LIKEWISE  THE 
PROGRAM  CAN  BE  HAlTED  UNDER  ODT  CONTROL. 

NOTE:  FOF:  CORRECT  OPERATION  OF  THIS  CODE,  PATCHES 
MUST  BE  MADE  TO  THE  ANALOG  COMPUTER.  BELOW  ARE 
LISTED  THE  NECESSARY  PATCHES. 

UPF  =  UNIVERSAL  PATCH  PANEL 
HIO  =  HYBRID  I/O  PATCH  PANEL 
DPP  =  DIGITAL  PATCH  PANEL 

UPP.OVL  -  UF'P.HOLD  FALLOWS  HOLD  STATE  WHEN  OVERLOAD  OCCURS 

DPR.CLK  -  HIO.RQSTA  ^INTERRUPT  FOR  I/O  UPDATE 

UPP.ABAR  -  HIO. LSI-11  DIGITAL  INPUT  1  *ALlOWB  CODE  TO  DETECT.... 
UF'F'.A  -  HIO. LSI-11  DIGITAL  INPUT  0  *.... ANAlOG  COMPUTER  MODE. 

NOTE:  CLK  BUS  DOES  NOT  WORK  UNLESS  IN  OPERATE  MODE. 

ABAR  A  !  ANALOG  COMPUTER  MODE 

0  0  !  DON'T  CARE 

0  1  !  I.  C.  MODE 

1  0  !  OPERATE  MODE 

1  1  i  HOLD  MODE 


EXTERNAL  GLOBLS 

. GLOBL  HBRKF’T  i  SYSTEM  IN  HOLD  ODT  BREAK  POINT 


EQUATES 


DIOCSR 

= 

170000 

) 

LSI-11  DIGITAi.  INPUT/ OUTPUT  STATUS  F.'Eu 

BIGIN 

= 

170004 

» 

LSI-11  DIGITAL  INPUT  REG 

T I  MP'SW 

= 

340 

9 

CLOCK  INTERRUPT  PSW 

DAOUTO 

= 

176750 

i 

D/A  OUTPUT  RCG 

DAOUT1 

r 

176752 

f 

D/A  OUTPUT  REG 

baout: 

= 

176754 

9 

D/A  OUTPUT  REG 

DA0UT3 

s 

176756 

9 

D/A  OUTPUT  REG 

THIS  PAGE  IS  BEST  QUALITY  PRACriCABlS 

A  X  C:  i'U  i/i^C 


ADCHO 

s 

OOOl 

* 

9 

A/D  CSR  COMMAND. 

GAIN  = 

X10 

ADCH1 

= 

0401 

* 

9 

A/D  CSR  COMMAND. 

GAIN  = 

X10 

ADCH2 

1001 

* 

9 

A/D  CSR  COMMAND. 

GAIN  = 

X10 

ADCH3 

1401 

9 

A/D  CSR  COMMAND. 

GAIN  = 

X10 

APCH4 

= 

2001 

* 

9 

A/D  CSR  COMMAND. 

GAIN  = 

X10 

ADCSR 

r 

176770 

4 

f 

A/D  STATUS  REG 

ADBUF 

s 

176772 

* 

9 

A/D  BUFFER  REG 

IC 

= 

6315 

VS  1 

s 

5 

4 

9 

*  of  elements  in 

VECTOR 

1 

MSI 

= 

5 

i 

4  ROWS  IN  mATk'jX 

1 

VS2 

- 

5 

f 

♦  OF  ELEMENTS  IN 

VECTOR 

«L 

M32 

= 

5 

> 

*  ROWS  IN  MATRIX 

2 

V53 

= 

5 

i 

*  OF  ELEMENTS  In 

VECTOR 

3 

Mi  3 

* 

— 

4 

1 

♦  ROWS  IN  MATRIX 

3 

begin: 

MOV 

#1000. SP 

MOV 

♦TIMEI. 8*320 

MOV 

#TIMPSW»@#322 

MOV 

#100.@#DI0CSR 

JMP 

ICMODE 

SET  STACK  POINTER 

SET  TIMER  INTERRUPT  VECT.  ABPRfRQST  A) 
SET  TIMER  INTERRUPT  VECTOR  F'SW 
ENABLE  ROST  A  INTERRUPT  ON  DIGITAL 
INPUT/ OUTPUT  CARD 
START  BY  ZEROING  B/A  OUTPUTS 


i  GET  SYNCHRONIZED  WITH  ANALOG  SYSTEM 


start: 


CHKOP . 


MOV 

MDIOIN.ARARA 

• 

9 

OBTAIN  ABAFl.A 

BIC 

*177774, ABFR A 

* 

9 

MASK  UNWANTED  BUS 

CMP 

#1 .  HLI'FLG 

9 

ARE  WE  PRESENTLY  IN  HOLD  ? 

BEQ 

CHKOF 

9 

YES 

CMP 

#3 . ABARA 

f 

NO.  WAS  HOLD  MODE  JUST  ENTERED  ? 

BEG 

HOLD 

i 

YES 

CMP 

*2. ABARA 

9 

WAS  OPERATE  MODE  JUST  ENTERED  ? 

BEG 

OF'ERAT 

» 

9 

YES 

CMF 

#0. ABARA 

9 

THIS  STATE  SHOULI  NEVER  OCCUR 

BEG 

START 

CMP 

#3 . ABARA 

9 

IF  IN  HOLD.  CHK  FOR  OPERATE  MODE 

BEG 

START 

IN  I. 

C.  MODE  **** 

>  INITIALIZATION  OF  ANALOG  COMPUTER  PARAMETERS 


icmode: 


initm: 


CLF: 

MDAOuTO 

9 

CLR 

(?#DAOUT  1 

» 

CLR 

0*DAOUT2 

9 

CLR 

0*DAOUT3 

9 

CLR 

ICNT 

9 

CLR 

HLDFLG 

9 

CLR 

R2 

9 

MOV 

♦  IC.DMA1  <  F:  2 ) 

MOV 

♦IC.DMA2(R2) 

ADD 

♦14.R2 

CMP 

#74. R2 

BNE 

INITM 

JMP 

START 

INITIALIZE  D/A 
INITIALIZE  D/A 
INITIALIZE  D/A 
INITIALIZE  D/A 

INITIALIZE  INTERRUPT  COUNTER 
INDICATE  NOT  IN  HOLD  MODE 
INITIALIZE  MATRIX  INPUTS 


THIS  PA <IF.  II  nr-.“ 

i’h 


'Ti  PKACTIOABLE 


C-3 


i  MM  SYSTEM  IN  HOLD  **** 

i  CLOCK  STOPS  AUTOMATICALLY  (OUT  OF  OPERATE  MODE) 

i  ASSUME  ODT  BREAKPOINT  AT  * HBRKPT 1 

»  IF  NO  BREAK  POINT  SET.  LSI-11  IS  STILL  IN  HOLD  STATE 

i  UNTIL  USER  PRESSES  OPERATE. 

hold: 

hbrkpt: 

MOV  #1 . HLDFLG  i  INDICATE  IN  HOLD  MODE 

JMP  START 

\  *t% *  SYSTEM  IN  OPERATION  **** 

operat: 

CLP  HLDFLG  i  INDICATE  NOT  IN  HOLD  MODE 

CLR  TIF..AG  i  INIT  TIMER  INTERRUPT  FLAG 


f  WAIT  FOR  TIMER  INTERRUPT 

f 

timeut: 


MOV 

(?#DIOIN  •  ABAFA 

f 

IC  OR  HOLD  KEY  PRESSED  ? 

BIC 

#1 77776. ABAPA 

f 

A  INDICATES  IN  I.  C.  OR  HOLD 

BED 

NOICH 

1 

NO  I.  C.  OR  HOLD  MODE  PRESSED 

JMP 

START 

• 

f 

YES.  GOTO  START 

CMP 

♦  1 » TIFLAG 

i 

TIMER  INTERRUPT  YET  ? 

BNE 

TIMEUT 

MULTIPLY  MATRIX  HD  •; KALMAN  FILTER  GAIN  MATRIX?  WITH 
VECTOR  Z  (SY5TEM  MEASUREMENT  VECTOR). 

HD  IS  5  ROUS  X  5  COLS 
Z  IS  5  ROUS  X  1  COL 


»  INITIALIZATION 

7 

MOV 

♦VS1.RO 

t 

MOV 

♦MMRA1.R2 

ini  i : 

CLR 

<R2)t 

DEC 

RO 

BNE 

INI  1 

MOV 

♦VS1.COLCNT 

MOV 

♦DMA1.R1 

colni: 

MOV 

♦MS1.RO 

MOV 

♦MMRA1.R2 

MOV 

( R 1 )  + .  R  3 

ROWNi: 

MOV 

(RD  +  .R4 

JSR 

PC.MUlT 

\  SCALE 
> 

ADD 

R4 . ( R2 )  + 

CLEAR  MATRIX  MULT.  RESULT  AREA 


ESTABLISH  VECTOR  SIZE 
DATA  MATRIX  START  ADDR 


ESTABLISH  MATRIX  ROU  SJ'.E 
INIT.  RESULT  ADDR . 

GET  OPERAND  *1 


GET  OPERAND  #  2 
16  BIT  SIGNED 


SUM  CORRESF'ONDING  TERMS 


\  CHECK  FDR  ADDITION  OVERFLOW 


DEC  RO 

»  THlY-  COLUMN  A..L  DuNl. 

PnE  ROiiiKU 

t  NO 

DEC  CDlCNT 

i  ALL  PULTIR'iIES  CPfv'Lf 

f 

DNE  CQLNi 

»  NO 

f 

t 

HUT 

:*ly  matrix  F-h*:r  ic 

LOSES  LOOP'  SrSTEr  ma”?!/. '•  wiT 

? 

VECTOR  U  (PAS T  STATE  VECTOR. . 

r 

PHI 

I.  IS  5  ROWS  >  5  COL 

c 

f 

* 

IS  5  ROUS  X  1  COL 

y 

I N  7  T 

*  A-  .  Z.  h  i  Q/t 

nC  V  ♦  USE  -  RO 

*  C- 1_  E  A  R  flATF. ;  a  ^  Ji..  :  .  F.  . 

y 

PC,  *h-iftAE'.F:D 

If 

: l r  ;r:,+ 

is:  RO 

POP  ini; 

pC-  #VS<  *OQLC 

^  1  r  t  b T  A ? i .  I  b **  El  .  0 F'  c  j.  Z l 

. 

m.  *DMAC»Ri 

j  I^A.A  HA  *  F  .1  f  i  AF  T  >- 

—  fi*J  • 

HO,  IP.S2.R0 

i  t.  b  >  A  P  w.  .  ■  ^  r  A  •  *  ♦*  '  *  v ! 

fiCv1  *pPRA2'F2 

5  INJU  EES.;.  T  A  III*. 

P.U »  ,  R 1 :  t  ?  R  2 

•  GET  CFlF.AN:1  #  1 

' 

UZ ; 

HO1.'  (Ri)  +  .R4 

*  GET  OFERAt.C  i  , 

»  - 

J?R  PC .MOLT 

.  16  SIT  s: 

y 

b  L  A  l. 

E 

*  *  y 

;<»  .•  R4.  TR25  + 

♦  SOP  CORRECT  D:  DING  It!' 

w 

:hel 

r.  run  ADi'CT iON  OVER 

•'  LOW 

*  * 

D  E  0  R  0 

-  THIS  COLUMN  ALi_  DONE 

PNE  ROUND 

;  no 

' 

DEC  COL  O'- ' 

«  ALL  MULTlP.ItS  C 0 P “  - : 

i  N COLNE 

;  no 

) 

L*  L 

EC  TCP  ADC:  r,C  COK-  J 

it.  U  ; . 1 1  >  i.L. 

y 

f 

W  \  i 

■41)1  -  1  h  i  i1  '  >  1  + 

♦  . 

HD*Z- f  ■  t 

I  : 

W  ( r. 

»  » 

♦  * 

1 1  ‘  r-<  -  ^  I D  *  w  K  )  N  t 

HD*Z  !  K n 

I 

AnO 

# 

UPf»* 

E  w  1  f  U I T H  fit.  WL  Y 

. A L C U L A T l W  f  \  I  L  1 

f 

MOV  ♦CP-'-C.F.l 

*  U  t  f  J  ;  "  1  F  *:  .  *  A  r  C  4 

1 

P  0 v  ♦MPRAlrFD 

\  i  £•♦:  RESULT  ST.'R" 

• 

MOV  ♦  M  P  F,  A  •  R  7 

1  F’H I  v  .*:►  .  ^  :  ► 

MOV 

♦  VS3  ?  COLCNT 

;  GET  ♦  OF  TERMS  TO  ADD 

MOV 

♦BMA2»R0 

{  U(K>  STORAGE  AREA  ADIift 

M  0  v 

<  F:  2 )  +  -  R  4 

i  GET  TERM  1 

MOV 

{ ft  3  >  4  *  ft  5 

i  GET  TERM  2 

ADO 

ft 5  -  ft  4 

t  DO  SIGNED  ADD 

BVC 

SC  All 

i  CHft  FOR  OVERF1..  JU 

T£f 

ft  5 

i  OVERFLOW.  SET  MA'  lImI 

Bc'i. 

MAX ROE 

t  SET  TO  POSITIVE  MAT  # 

M  0  L 

♦  1)0000 ?  ft 4 

i  SET  TO  NEGATIVE  MA>  # 

JM' 

SCALi 

MOV 

♦7“??7  f  F’4 

i  positive  ha;-;  ♦ 

M  0  V 

F:  4  • ,  ft  i  .■ 

i  STORE  R.ESulT  «  !■  4 1  ’• 

ft  4  .  ;  F.O  ■ 

•  S  ~  ft  E  L  *'  '■  *  1 

-  ? 

COlCn'1 

:  Crir,  IF  ALl  TER  Pi  ADutr 

i,r : 

0  u  N  E  4 

p. 

♦  MS 1  *  2 » ftl 

}  ADJUST  STORAGE  ADDR'tS 

*, 

MM  _ 

#H52t1*2>R0 

T“  * 

ALI'N)  * 

:  _  -  Hi-  ■  j-;  gd  closed  loo? 

.-ECTOR  »  <  NEXT  STATE  1 
*  4  •*  r  •“  i  c,  r.  ql 

cEt. DSACi.  MATH.'- 
.  £ i t Or  ■ 

WITH 

:  S  R  C  *  I  3  C  £■  l. 

t--L  .TZ.R  " 

S  rJ 

|-n 

♦VST.ao 

CLEAR  MATE 

IX  MULT.  RES 

*r. 

♦  MMF;aS  • c  ‘ 

'  R2  i  i 

DF  “ 

F'O 

?'jl 

V 

♦  v  :■  LCtr 

F 

£  S  T  m  R  <  Sh 

vector  s::f 

riC'v 

♦DrA3*f;i 

♦ 

DATA  M“*R  1 

*  S  T  A  F,  i  A  D  A  ft 

M  Q  ■; 

♦  r  S  5  !  F:  0 

i 

;•  -~PE;  !  Ah 

^  h  "!  P  i  »  k  » •  u>  b 

-  j 

♦  rrft-'j .  p: 

» 

r  r» 

.Pi  •  F:  3 

GE.T  CftE'Ar 

:  i , 

m 
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